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By 
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Major  Department:  Mechanical  Engineering 

State  of  the  art  industrial  robot  manipulators  typically 
feature  a serial  sequence  of  simple  joints.  Serial  robotic 
devices  have  been  the  subject  of  much  study.  The  same  cannot 
be  said  for  parallel  devices  where  two  or  more  serially  con- 
nected subchains  join  an  end-effector  platform  to  ground. 

Such  devices  do  exist  and  are  beginning  to  be  studied  in 
industry  as  potential  robot  manipulators.  This  dissertation 
presents  a fundamental  study  of  these  alternative  devices  to 
provide  a basic  understanding  and  to  assess  some  of  the 
practical  aspects. 

A type  synthesis  of  parallel  robotic  devices  is  performed 
using  an  algorithm  based  on  Franke ' s condensed  notation.  This 
is  followed  by  a discussion  of  potential  robotic  applications. 

xiii 


This  dissertation  essentially  covers  two  major  topics: 
instantaneous  kinematics  and  joint  displacement  analysis  of 
fully-parallel  devices.  Firstly,  two  novel  procedures  for 
determining  the  instantaneous  motion  of  the  end-effector 
platform  of  fully-parallel  devices  using  the  theory  of 
screws  are  presented  and  an  important  theorem  is  derived 
for  any  parallel  device,  the  twist  representing  the  instan- 
taneous motion  of  the  end-effector  platform  is  equal  to  the 
sum  of  its  partial  twists.  Equally  important,  a character- 
istic matrix  equation  is  derived  and  used  to  describe  and 
categorize  various  geometrical  phenomena  called  "special 
configurations"  which  are  by  no  means  fully  understood. 

Six  different  types  of  special  configurations  are  tabulated. 
By  the  way  of  example  special  configurations  of  the  planar 
Florida  Shoulder  are  studied  in  detail  and  numerical  results 
are  provided.  Secondly,  the  joint  displacement  analysis  of 
the  planar  Florida  Shoulder  is  presented.  This  is  followed 
by  presenting  the  reverse  joint  displacement  analysis  of  the 
well  known  Stewart  Platform  and  also  of  the  R-P-SP  spatial 
robotic  device  with  three  subchains  connecting  the  end- 
effector  platform.  Numerical  examples  are  presented  for 
each  device.  Computer  programs  for  the  displacment  analysis 
are  listed  in  the  appendices. 
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CHAPTER  1 
INTRODUCTION 

1 . 1 Dissertation  Overview 

Almost  all  existing  industrial  robot  manipulators  are 
serial  devices  and  have  been  the  subject  of  much  study. 

Their  joint  displacement  analysis  and  instantaneous  kinematics 
are  fairly  well  understood.  The  same  cannot  be  said  for 
parallel  devices  where  two  or  more  serially  connected  chains 
join  a platform  or  end-effector  to  ground.  Such  devices  do 
exist.  For  instance,  the  Stewart  Platform  which  has  six 
serial  connecting  chains  in  parallel  is  used  for  flight 
simulation.  The  Florida  Shoulder,  which  is  essentially  a 
spherical  parallel  device,  can  be  used  as  a module  device  in 
robot  systems.  These  types  of  devices  are  beginning  to  be 
studied  in  industry  as  potential  robot  manipulators.  In  this 
dissertation  a fundamental  study  of  parallel  devices  is  pre- 
sented in  order  to  provide  a basic  understanding,  and  to 
assess  some  of  the  practical  aspects  of  these  devices. 

As  suggested  by  the  title,  this  dissertation  essentially 
covers  two  major  topics.  First,  the  instantaneous  kinematics 
of  general  fully-parallel  devices  is  investigated  using  the 
theory  of  screws.  Second,  the  joint  displacement  analysis  of 
a number  of  fully-parallel  devices  is  presented. 
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In  Chapter  2 line  geometry  is  summarized  and  then 
extended  to  the  theory  of  screws  which  constitutes  a proper 
foundation  for  the  study  of  instantaneous  kinematics. 

In  Chapter  3 a type  synthesis  of  parallel  robotic 
devices  is  performed  using  an  algorithm  based  on  Franke's 
condensed  notation.  This  yields  the  structure  of  all  planar 
and  spatial  robotic  devices  for  which  the  end-effector 
platform  has  three  and  six  degrees  of  freedom.  This  is 
followed  by  a discussion  of  potential  robotic  applications. 

In  Chapter  4 two  novel  procedures  are  presented  for 
determining  the  instantaneous  motion  of  the  end-effector 
platform  of  f ully-parallel  devices  and  an  important  theorm 
is  derived:  For  any  parallel  device ^ the  twist  representing 

the  instantaneous  motion  of  the  platform  is  equal  to  the 
sum  of  its  partial  twists.  Equally  important,  a character- 
istic matrix  equation  which  completely  describes  the  instan- 
taneous kinematics  of  parallel  devices  is  also  derived. 

In  Chapter  5 the  characteristic  matrix  equation  is  used 
to  describe  and  categorize  special  configurations  of  fully- 
parallel  devices.  Six  different  types  of  special  configura- 
tions are  tabulated.  By  the  way  of  example,  special  con- 
figurations of  the  planar  three-degree  of  freedom  Florida 
Shoulder  are  studied  in  detail  and  numerical  results  are 
provided . 

In  Chapter  6 the  forward  and  reverse  displacement  analy- 
sis of  the  planar  Florida  Shoulder  is  presented. 


3 


In  Chapter  7 the  reverse  displacement  analysis  of  a 
number  of  practical  six-degree  of  freedom  spatial  robotic 
devices  is  presented. 

Chapter  8 gives  suggestions  for  future  work. 

By  way  of  introduction  in  the  remainder  of  this  chapter, 
fully-  and  partially-parallel  devices  are  defined  and  exam- 
ples of  each  are  presented.  The  performance  characteristics 
of  serial  and  parallel  robotic  devices  are  summarized  and 
compared . 

1.2.  Serial  and  Parallel  Kinematic  Chains 
1.2.1.  Definitions 

A serial  kinematic  chain  is  a single  open-loop  kinematic 
chain  of  rigid  bodies  (or  links)  connected  by  a series  of 
joints  [1].  Alm.ost  all  existing  industrial  robot  manipulators 
are  serial  chains,  and  in  most  cases  simple  lower  pairs  (revo- 
lute or  prismatic  pairs)  are  used.  Figure  1.1  illustrates  an 
industrial  serial  robot  manipulator  with  six  controllable 
rotational  freedoms  in  series. 

Hunt  in  [2]  defined  "in-parallel-actuated  kinematic 
chains."  Examples  are  the  planar  device  (Fig.  1.2)  where  the 
platform  is  connected  to  ground  by  three  subchains,  the 
spherical  version  of  which  is  the  Florida  Shoulder,  and  the 
spatial  Stewart  Platform  (Fig.  1.3)  which  is  connected  to 
ground  by  six  subchains.  Each  of  these  devices  can  be 
controlled  by  a single  actuator  in  each  of  the  subchains. 
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Figure  1,1. 


Industrial  Serial  Manipulator 
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Figure  1.2.  Three-Degree  of  Freedom  Planar  Shoulder 


end-effector  platform 
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Figure  1.3.  Six-Degree  of  Freedom  Stewart  Platform 
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The  actuators  are  therefore  in-parallel  to  one  another  and 
this  is  the  basis  for  Hunt's  definition.  However,  Fig.  1.4 
illustrates  a spatial  platform  connected  to  ground  by  three 
subchains.  Although  as  in  the  previous  device  the  subchains 
are  fully  in-parallel,  the  actuators  are  not  fully  in-parallel. 
All  of  these  three  devices  will  be  defined  in  this  text  as 
fully-parallel  devices.  A fully-parallel  device  is  defined 
as  a platform-type  kinematic  chain  in  which  the  actuated 
connected  subchains  are  fully  in-parallel  with  one  another. 

It  is  necessary  to  introduce  the  term  fully-parallel 
device  here  in  order  to  distinguish  between  devices  such  as 
those  illustrated  in  Fig.  1.5  which  will  be  defined  as 
partially-parallel  devices  (the  actuators  are  not  in-parallel 
with  one  another) . Hunt  himself  pointed  out  that  there  are 
many  intermediate  possibilities  between  fully-parallel  and 
serial  devices  [3].  The  authors  of  [4-7]  also  discussed 
these  intermediate  possibilities  and  they  are  sometimes  re- 
ferred to  as  hybrid  serial-parallel  devices.  However,  they 
will  be  called  partially-parallel  devices  in  this  text. 

1.2.2  Comparison  between  Serial  and 
Parallel  Devices 

A comparison  between  general  serial  and  parallel  devices 
in  terms  of  some  necessary  and  desirable  performance  and  con- 
trol characteristics  was  presented  in  great  detail  in  [4]. 

Some  of  these  characteristics  were  also  proposed  in  [2,6-8]. 

Eight  of  these  performance  characteristics  were  discussed 
in  [4].  These  characteristics  are: 


-end-effector  platform 
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Figure  1.4.  Six-Degree  of  Freedom  Spatial  Shoulder 
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end-effector 


end-effector 


Figure  1.5.  Partially-Parallel  Devices 


10 


- Range  of  motion  or  workspace 

- Rigidity  or  stiffness  and  strength 

- Complexity  of  end-effector  positioning  formulation 

- Complexity  of  system  dynamics 

- Precision  positioning 

- Load  carrying  distribution  through  system 

- Fabrication  (economics) 

- Compactness 

Further,  Fig.  1.6  illustrates  a performance  chart  which  indi- 
cates, in  a relative  manner,  which  characteristics  or  criteria 
tend  to  be  favorable  for  serial  and  parallel  devices.  This 
chart  is  a modif ied-version  of  the  performance  chart  pre- 
sented in  [ 4 ] . 
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range  of  motion  ( working i volume 


ease  of  computation  for  tlie  end-effector  positioning 


ease  of  computation  for  svstem  dynamics 


precision  positioning 


load  carrying  distributioA  through  system 


fabrication  (economics) 


compactness 


serial  kinem.atic  chain 


parallel  kinematic  chain 


Figure  1.6.  Perform.ance  Chart 


CHAPTER  2 

INTRODUCTORY  DISCUSSION  OF  THE  THEORY  OF  SCREWS 

The  major  objective  of  this  chapter  is  to  give  a summary 
of  the  theory  of  screws  and  its  application  in  investigating 
the  instantaneous  kinematics  of  serial  manipulators.  First, 
line  geometry  is  summarized  and  then  extended  to  the  theory 
of  screws.  A brief  historical  remark  which  outlines  the 
development  of  the  theory  of  screws  is  presented.  Following 
this,  the  dual  concepts  of  instantaneous  kinematics  and 
statics  of  rigid  bodies  are  investigated  using  the  theory  of 
screws.  The  so-called  "Series"  and  "Parallel"  laws  of  instan- 
taneous kinematics  are  presented,  and  then  the  series  law  is 
applied  to  investigate  the  instantaneous  kinematics  of  an 
open  chain  of  rigid  bodies  connected  by  a series  of  joints. 
This  system  models  the  robot  manipulator. 

2 . 1 Line  Geometry 

2.1.1  Pliicker  or  Line  Coordinates 

A line  in  space  can  be  determined  by  two  intersecting 
planes*  or  by  two  distinct  (independent)  points. 


*In  three  dimensions  a plane  is  said  to  be  the  dual  of  a 
point.  For  every  theorem  involving  points,  there  exists 
a corresponding  dual  theorem  which  can  be  obtained  simply 
by  interchanging  the  words  point  and  plane,  and  of  course 
by  modifying  phrases  to  make  the  statement  sensible. 
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The  equation*  (nonparametric)  of  the  unique  line  joining 
point  and  point 


where  (x^-x^) , 
of  a vector 


x-x. 


^2  ^1 


y-^i 

Y2-yi 


z-z 


^2~^1 


(2.1) 


(y^-y^)  , and  (Z2~Z]^)  the  direction  ratios 


S = (x^-x^)!  + (y2-Y3^)i  + 


(2.2) 


parallel  to  the  line,  and  they  are  related  to  the  distance 
|s|  between  the  two  points  by 


S . S 


|S|2=  (x2-x^)^  + (y2-Yi)^  + 


It  is  usual  to  write 

L = (x^-x^) / I S I 
M = (y2-Yi)/lsl 

N = {z^-z^)/\s\  (2.4) 


where  L,  M,  and  N are  the  direction  cosines  (unit  direction 


*The  Pliicker  coordinates  (S  ; Sq)  of  the  line  of  intersection 
of  two  planes  (see  [9]  for  more  details) , 

r . Si  = 

and  r . S2  “ ®2 

S = X £2 
^ ®2§.l  “ ®l§.2 

When  Si  XS2  = 0,  the  planes  are  parallel  and  they  intersect  at 
a line  with  coordinates  (0  ; Sq)  the  plane  at  infinity. 
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ratios)  of  the  line,  or  of  any  other  parallel  line.  Only 
two  of  these  are  independent  since  they  are  related  by 

1 = (2.5) 

The  vector  equation  of  the  line  can  be  expressed  in  the  form 

r X S = S ^ (2.6) 

where 

S = r^  X S (2.7) 

— o — 1 — 

is  the  moment  of  the  line  about  the  origin.  S is  origin 

— o 

dependent  while  S is  not.  The  components  of  the  moment 
along  the  x,  y,  and  z axes  are,  respectively, 

P = y^N  - z^M 

Q = z^L  - x^N 

R = x^M  - y (2.8) 

The  quantities  L,  M,  N,  P,  Q and  R must  satisfy  the  quadratic 
condition  of  orthogonality 

S . S =0  (2.9) 

— — o 

i . e . , 

LP  + MQ  + NR  = 0 (2.10) 

Thus  the  six  coordinates  (L,M,N  ; P,Q,R)  can  therefore  be 
used  to  specify  a unique  line  in  space  (see  Fig.  2.1).  These 
six  coordinates  are  often  referred  to  as  Pliicker's  line  coor- 
dinates or  simply  Pliicker  or  line  coordinates  (S  ; £^)  . The 
coordinates  (S  ; ^)  are  homogeneous  coordinates  since  from 

(2.6)  the  coordinates  (XS  ; XS  ) , where  X is  a scalar, 

— — o 
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Figure  2.1.  Pliicker  Line  Coordinates 
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determine  the  same  line.  Only  four  of  these  six  coordinates 
are  independent  since  they  are  related  by  (2.5)  and  (2.10), 
and  hence  it  can  be  concluded  that  there  are  lines  in 
space . 

The  vectors  S and  can  be  combined  into  a dual 
* 

vectors 

^ = S + sSq  (2.11) 

where  e^=  ...  = 0.  The  vector  S is  called  a line  vector 

[lO]  and  when  |S|  =1,  ^ is  called  a unit  line  vector. 

If  P,  Q,  and  R are  all  zero,  then  the  line  passes 
through  the  origin;  while  if  L,  M,  and  N are  all  zero,  the 
line  lies  in  the  plane  at  infinity.  The  line  is  then  per- 
pendicular to  a finite  line  whose  direction  cosines  are  P, 

Q,  and  R.  For  instance,  the  line  at  infinity  (0,0,0  ; 0,0,1) 
is  perpendicular  to  the  Z-axis.  Such  lines  whose  rotation 
axes  are  infinitely  distant  from  the  origin  require  the 
modified  set  of  coordinates  (^  ; S)  and  are  recognized  as 
unit  free  vectors. 

A line  in  three-dimensional  space  can  be  represented  as 
a point  in  five-space,  the  homogeneous  coordinates  of  the 
point  being  (L,M,N  ; P,Q,R) . But  the  quadratic  identity 
(2.10)  has  to  be  satisfied,  and  this  is  the  equation  of  a 
quadric  surface  in  five-space.  Hence  we  conclude  that  a 

*Dual  numbers  and  dual  vectors  provide  a useful  means  of 
manipulating  Plucker  coordinates  - and  indeed  screw  coor- 
dinates, see  section  2.2.  Briefly,  a dual  number  has  a 
real  part  a and  dual  part  b,  and  is  written  as  a+eb  where 
e^=e^=  ...  = 0.  a can  be  identified  with  |S|=  (L^+m^+n^)^ 
and  b with  | S o | = (P^ +Q^ +R^  ) *^ . Then  it  is  often  useful  to 
consider  a and  b as  vectors  a and  b (or  S and  ) . 
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line  in  three-space  can  be  represented  as  a point  on  the 
quadric  surface,  LP  + MQ  + NR  = 0 , in  five-space. 


2.1.2  Mutual  Moment  of  Two  Lines 

Figure  2.2  illustrates  two  skew  lines  with  a mutual  per- 
pendicular distance  ^2_2  twist  angle  012^2*  The  vector 

equations  of  those  two  lines  are,  respectively 


r,  X = S 
—1  —1  — ol 


(2.12) 


and 


^2 


^ S = S 

—2  — o 2 


(2.13) 


The  projection  of  the  moment  vector  ^3^2— 12^— 2 line 

is  given  by  ^2.2^12  ^ —2  ' —1  called  the  moment  of 

about  the  line  S ^ . This  scalar  quantity  is  usually  called 
the  mutual  moment  of  the  two  lines.  Expanding  the  triple 
scalar  product,  the  mutual  moment  can  be  expressed  in  the 
form 


-ai2  sin  ' 

^2  ^2 

• 

= h^2 

+ M^Q^  t 

+ + R^N^ 

(2.14) 

where  (L^,M^,N^  ; P2.'^i 

, R^)  and 

(L^,M2,N2  ; 

^2'Q2'^2^  are 

the  Pliicker  coordinates  of  the  two  lines. 

Two  lines  will  intersect  at  a finite  point  (^2.2”^^  ' 
at  a point  at  infinity  (sin  only  if  their 

mutual  moment  is  zero.  Hence  the  condition  for  the  inter- 
section of  two  lines  is 


S - + S„ 
— o 2 — 2 


0 


(2.15) 
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Figure  2.2.  Pair  of  Skew  Lines 
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The  point  of  intersection  r of  a pair  of  two  skew  lines  (2.12) 
and  (2.13)  can  be  expressed  in  the  form  [9] 


r 


X S „ 
— o2 


(2.16) 


If  S . S =0  then  the  two  lines  intersect  at  a point 
— 2 — o 1 

at  infinity,  and  if  in  addition  x ° inde- 

terminate and  the  two  lines  are  identical  or  opposite. 


2.1.3  Line  Systems* 

4 

It  has  been  shown  earlier  that  there  are  °°  lines  in 
space.  However,  every  condition,  relation,  or  equation  in 
the  coordinates  of  the  lines  reduces  the  freedom  of  the  space 
by  one,  i.e.,  reduces  the  number  of  lines  in  the  space  from 

4 4.  3 

CO  to  °°  . 

since  only  two  of  the  equations  (2.8)  of  the  moment  com- 
ponents of  a line  passing  through  a point  are  independent, 
therefore  the  condition  that  a line  should  pass  through  a 

point  imposes  two  constraints  on  the  line.  Thus  only  two 

2 

parameters  are  left  to  be  determined.  Hence  there  are  ” 
lines  passing  through  a point  and  they  form  a line  congruence. 

If  L^,  M^,  and  are  the  direction  cosines  of  a given 
line,  and  L,  M,  and  N are  the  direction  cosines  of  a parallel 
line,  then 

= L : M : N (2.17) 


*Line  systems  and  their  properties  are  described  by  Hunt  [3] 
which  contains  an  extensive  bibliography  on  the  subject. 


20 


which  implies 


ML^ 

II 

NL^ 

= LN^ 

(2.18) 

Equation  set  (2.18)  represents  two  independent  conditions 

2 

and  therefore  it  is  concluded  that  ther  are  °°  lines  paral- 
lel to  a given  line.  They  also  form  a line  congruence. 

Line  (S  ; ) will  lie  on  the  plane  (a  ; s) , if  and 

only  if, 

(a  . S)  = 0 

and 

S.(axSQ)=-s  (2.19) 

2 

Therefore  it  is  concluded  that  there  are  °°  lines  on  a given 
plane . However,  the  line  and  the  plane  will  be  just  parallel 
if  only 

(a  . S)  = 0 (2.20) 


Since  equation  (2.20)  is  the  only  constraint,  it  is  concluded 
that  there  are  °°  lines  parallel  to  a given  plane.  Such 
lines  form  a line  complex. 

Similarly,  it  can  be  concluded  that  there  are  lines  on 
a given  plane  that  pass  through  a point  in  that  plain.  Such 
lines  form  a planar  pencil.  In  general,  there  will  be 
lines  forming  a line  series  (ruled  surface)  that  satisfies 
three  conditions.  Four  conditions  leave  just  °°°  lines;  i.e., 
a finite  number  of  lines.  Ordinarily,  no  line  satisfies 


five  conditions. 
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2 . 2 The  Theory  of  Screws 

The  theory  of  screws  is  analogous  to  vector  analysis  in 
that  both  consist  of  an  algebra  with  a geometric  entity  as  a 
fundamental  element.  The  vector  is  the  fundamental  element 
for  vector  analysis,  and  the  screw  is  the  fundamental  ele- 
ment for  the  theory  of  screws.  All  operations  in  the  vector 
domain  are  formally  preserved  for  the  screws.  A screw  is 
essentially  a vector  in  six-space  and  a screw  equation  is 
equivalent  to  six  scalar  equations. 

The  concepts  of  screws,  twists,  and  wrenches  are  intro- 
duced in  this  section.  It  is  shown  how  the  previously  en- 
countered line  coordinates  can  be  extended  to  screw,  twist, 
and  wrench  coordinates. 

2.2.1  Historical  Remarks  on  Screws 

Since  the  discovery  (attributed  to  Mozzi,  in  the  early 
part  of  the  last  century)  that  any  three-dimensional  rigid 
body  displacement  can  be  accomplished  by  means  of  a transla- 
tion about  a unique  axis  and  a rotation  about  the  same  axis, 
the  concepts  of  screws  and  screw  displacements  have  emerged 
as  some  of  the  most  convenient  means  of  describing  spatial 
displacement.  In  1900,  R.S.  Ball  published  his  monumental 
"Theory  of  Screws"  [11] . The  theory  as  developed  by  Ball  is 
concerned  principally  with  the  instantaneous  kinematics  and 
the  impulsive  dynamics  of  a rigid  body  subject  to  complex 
constraints.  There  have  arisen,  however,  different  mathe- 
matical methods  of  representing  the  spatial  motion  of  a 
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rigid  body.  Rooney, for  example,  compared  eight  of  these 
descriptions  in  [ 12] , and  Lipkin  and  Duffy  gave  a brief 
introduction  to  some  of  these  methods  in  [13] . 

After  the  first  decade  of  the  20th  century,  the  theory 
of  screws  received  little  attention.  It  was  not  until  1948 
that  Dimentberg  [14]  applied  the  algebra  of  the  theory  of 
screws  to  the  analysis  of  spatial  mechanisms.  However,  it 
was  Phillips  and  Hunt  [15]  in  the  1960 's  who  applied  the 
theory  of  screws  to  the  study  of  instantaneous  kinematics  of 
three  bodies  in  relative  motion.  They  rediscovered  some  of 
the  earlier  results  of  Ball,  and  subsequently  applied  the 
theory  of  screws  to  spatial  mechanisms.  In  addition,  the 
works  of  Waldron  [l6l,  Bottema  and  Roth  [l?]  provided  a 
modern  mathematical  understanding  of  the  theory  of  screws. 

In  [18],  Woo  and  Freudenstein  developed  screw  coordinates 
which  are  a direct  extension  of  the  Plucker  coordinates  of 
a line.  These  are  different  from  the  screw  coordinates 
originally  introduced  by  Ball  [ll].  Ball's  approach  was  to 
choose  six  independent  screws  as  reference  screws;  other 
screws  could  then  be  determined  by  finding  the  respective 
magnitudes  of  their  components  along  the  reference  screws. 

2.2.2  Screws  and  Screw  Coordinates 

A screw  was  defined  by  Ball  [11]  as  a straight  line  in 
space  with  which  a definite  scalar  called  the  pitch,  h,  is 
associated.  The  straight  line  is  called  the  screw  axis. 
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The  six  Plucker  line  coordinates  can  be  extended  to  a 
set  of  screw  coordinates.  If  ( L,M,N  ; P,Q,R)  are  the  Plucker 
coordinates  of  the  screw  axis,  then  the  screw  coordinates  are 
(S  ; So)  where 


'is  "ic 

S = Li  + M2  + Nk 


^ = Pi  + q5  + Rk 


(2.21) 


and 

L*  = L 

M*  = M 

N*  = N 

P*  = P + hL 

Q*  = Q + hM 

R*  = R + hN  (2.22) 


A unit  screw  S_  . S_=  1,  can  also  be  expressed  as  a dual 
vector 


i = S + S (2.23) 

^ — — o 

where 

S o = r X S + hS  (2.24) 

The  six  screw  coordinates  (2.22)  do  not  satisfy  the  quadratic 
condition  of  orthogonality,  S . 7^  0 . Therefore,  it  can  be 

concluded  that  a screw  can  be  uniquely  specified  by  five 
independent  quantities  (coordinates) , four  for  the  axis  and 
one  for  the  pitch. 

§0  • §. 

If  the  pitch,  (h  = ^ c~  ) ^ zero,  then  the  screw 

coordinates  are  identical  with  the  line  coordinates.  For 
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a screw  with  infinite  pitch,  L*,  M* , and  N*  will  all  be  zero 
and  the  screw  coordinates  are  identical  with  the  free  line 
vector  coordinates. 

Since  there  are  screws  in  three-space,  a screw  can 
be  regarded  as  a point  in  five-space  [19],  and  now  the  total 
ity  of  all  screws  of  all  pitches  account  for  all  points  in 
five-space.  However,  by  virtue  of  the  quadratic  identity 
(2.10),  all  screws  of  zero  pitch  in  five-space  can  be  rep- 
resented as  the  points  on  a quadric  which,  when  h = 0,  can 
now  be  written  LP  +MQ  +NR  =0.  It  follows  that 
there  is  a nesting  pattern  of  quadric  surfaces  in  five- 
space  each  quadric  having  its  own  characteristic  pitch- 
parameter.  The  points  on  one  such  quadric  correspond  with 
those  screws  in  three-space  of  that  particular  pitch.  It  is 
important  to  notice  that  there  can  be  no  points  common  to 
any  two  of  the  nesting  quadrics  and  therefore,  no  point  can 
represent  more  than  one  screw. 

2.2.3  Screw  Systems 

A screw  system  of  order  n is  defined  as  a vector  space 
formed  by  all  possible  linear  combinations  of  n independent 
instantaneous  screw  axes  (ISA's).  The  order  of  the  screw 
system  of  a joint  is  the  connectivity  of  that  joint  which 
is  the  number  of  relative  degrees  of  freedom  of  the  bodies 
connected  by  the  joint.  The  intersection  of  two  screw 
systems  is  itself  a screw  system. 

The  screw  system  of  order  zero  contains  no  ISA's,  that 
of  order  one  is  a single,  unique  ISA.  Screw  systems 
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associated  with  revolute,  prismatic,  and  screw  joints  are  of 
order  one  (Figs.  2. 3-2. 5).  The  screw  system  of  order  two  is 
a set  of  ISA's  whose  axes  are  the  generators  of  a ruled  sur- 
face called  a "Cylindroid . " The  pitch  of  each  ISA  in  this 
distribution  is  a unique  function  of  its  position  on  the 
cylindroid.  Finally,  the  screw  system  of  order  six  con- 
tains the  set  of  all  ISA's. 

2.2.4  Inatantaneous  Kinematics  of 
a Rigid  Body 

Consider  that  body  2 in  Fig.  2.3  is  now  rotating  about 
an  axis  with  angular  velocity  wS.  The  tangential  velocity 
of  a point  on  body  2 which  is  instantaneously  coincident  with 
the  origin  of  the  coordinates,  0,  is  to  (r  x S)  . Therefore, 
the  instantaneous  rotation  can  be  expressed  as  a scalar 
multiple  of  the  unit  line  vector,  to[S  ; (r  x S)  ] . 

If  the  body  translates  in  direction  S (Fig.  2.4)  with 
linear  velocity  vS,  then  the  instantaneous  translation  of 
the  body  can  be  expressed  as  a scalar  multiple  of  a unit 
free  vector,  v[0  ; S] . 

The  most  general  instantaneous  motion  of  body  2 relative 
to  body  1 is  a combination  of  an  instantaneous  rotation  (Fig. 
2.3)  and  an  instantaneous  translation  (Fig.  2.4)  as 
illustrated  by  Fig.  2.5.  Since  the  linear  velocity  v is 
parallel  to  the  angular  velocity  u,  then  v can  be  expressed 
as  a scalar  multiple  of  co. 


V = hoj 


(2.25) 
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Figure  2.3. 


Pure  Rotation 
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S 


v=vs 


Figure  2.4.  Pure  Translation 
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Figure  2.5.  Twist  about  a Screw 
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The  translational  velocity  of  a point  on  body  2 which  is  in- 
stantaneously coincident  with  the  origin  of  the  coordinates  is 


y = Vq  + V (2.26) 

i . e . , 

y_  = o)[  (r  X S)  + hS] 

= (2.27) 

Therefore,  the  instantaneous  motion  can  be  expressed  by  the 
dual  vector 


0)^  = m + ey_ 

= a)[S  + bSq] 

= I (2.28) 

which  is  a scalar  multiple  of  a unit  screw  with  a unique 

So  • S , . . j 

pitch,  h,  (h  = ) . Ball  called  this  motion  a twist  £ 

S . S 

of  amplitude  (jj  about  a unit  screw  Generally,  the  instan- 

taneous relative  motion  of  two  bodies  connected  by  a joint  of 
connectivity  n may  take  place  and  can  be  expressed  as  a twist 
about  any  ISA  which  is  a member  of  the  screw  system,  of 
order  n,  of  that  joint. 

It  can  be  deduced  that  a pure  rotation  can  be  expressed 
as  a twist  about  a screw  with  pitch  h = 0,  while  a pure 
translation  can  be  expressed  as  a twist  about  a screw  with 
pitch  h = 00 . 


2.2.5  Statics  of  a Rigid  Body 

Analogous  to  instantaneous  kinematics,  unit  screws  can 
be  used  to  express  the  action  of  a force  and/or  a couple  on 
a rigid  body. 
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The  most  general  system  of  forces  and  couples  acting  on 
a rigid  body  can  be  in  general  reduced  to  a force  acting 
through  a point  and  a non— parallel  couple.  This  combination 
of  force  and  non-parallel  couple  was  called  a "Dyname"  by 
Pliicker.  The  dyname  can  be  further  reduced  to  a force  and 
a parallel  couple  which  in  turn  can  be  represented  as  a 
scalar  multiple  of  unit  screw.  Therefore,  any  force  system 
acting  on  a rigid  body  can  be  instantaneously  represented  as 
a wrench  of  intensity  F on  a unit  screw  with  pitch  h, 

(h  = -o  ’ - ) . Also  it  can  be  deduced  that  a force  can  be 

S . S 

expressed  as  a wrench  on  a screw  with  pitch  h = 0,  while  a 
couple  can  be  expressed  as  a wrench  on  a screw  with  pitch 
h = “. 

The  remaining  discussion  about  the  theory  of  screws 
is  delayed  until  the  end  of  the  chapter  (in  2.3.3  and  2.3.4) . 

2. 3 Introduction  to  the  Instantaneous 

Kinematics  of  Kinematic  Chains 

The  study  of  instantaneous  kinematics  of  kinematic 
chains  was  pioneered  by  Waldron  [20].  He  discussed  the  con- 
cepts of  constraint,  mobility,  and  relative  degrees  of  free- 
dom in  a kinematic  chain.  He  introduced  two  laws  which  are 
fundamental  to  the  instantaneous  kinematics  of  kinematic 
chains.  These  are  known  as  the  series  and  parallel  laws, 
which  have  direct  analogues  in  the  electrical  circuit  theory. 

At  the  outset,  it  is  important  to  notice  that  only  in- 
stantaneous motions  are  considered  since  such  motions  are 
commutative.  Now  it  is  necessary  to  distinguish  between 
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two  types  of  joints.  A joint  in  which  the  bodies  joined  may 
or  may  not  be  in  contact,  but  all  the  constraints  are  not 
provided  by  contact  between  the  bodies  joined  is  called  a 
"Complex  Joint"  by  Waldron.  The  other  type  is  a joint  in 
which  all  the  constraints  are  provided  by  the  direct  physical 
contact  of  the  two  joined  bodies  alone.  This  joint  is 
called  a "Simple  Joint"  or  simply  a joint.  Both  types  of 
joints  will  be  discussed  in  the  next  section. 

2.3.1  The  Series  and  Parallel  Laws 
of  Instantaneous  Kinematics 

Consider  that  a body  2 is  connected  to  a body  1 by  a 
joint  of  connectivity  m and  that  a body  3 is  connected  to 
the  body  2 by  a joint  of  connectivity  n (see  for  example 
Fig.  2.6  for  which  m =3  and  n =1) . The  instantaneous  motion 
of  body  3 relative  to  body  1 is  dtermined  by  the  screw 
system  of  the  complex  joint  between  these  two  bodies.  This 
resultant  screw  system  is  formed  by  screws  of  the  two  screw 
systems  of  both  joints  simultaneously  and  it  is  of  order 
m+n-k  where  k is  the  order  of  the  intersection  of  the  two 
screw  systems.  For  the  example  in  Fig.  2.6,  k = 1 and  thus 
the  order  of  the  resultant  screw  system  is  3.  When  k = 0 
the  intersection  of  the  two  screw  systems  contains  only  the 
zero  vector  and  therefore  the  order  of  the  resultant  screw 
system  is  simply  m+n.  In  such  cases,  the  bodies  are  said 
to  be  serially  connected,  and  the  above  law  is  called  the 


series  law. 
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Figure  2.6. 


Two  Joints  in  Series 
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Consider  now  that  two  bodies  are  connected  by  a pair  of 
joints  with  connectivity  in  and  n (see  Fig.  2.7)  . Their  rela- 
tive motion  is  subjected  to  the  constraints  of  both  joints 
simultaneously.  Clearly,  motion  can  now  only  occur  about 
the  ISA's  which  are  members  of  the  screw  systems  of  both 
joints.  Therefore,  if  the  order  of  the  intersection  of  the 
two  screw  systems  is  k,  the  connectivity  of  the  complex  joint 
between  the  two  bodies  is  also  k.  The  two  joints  are  said  to 
be  acting  in  parallel,  and  the  above  law  is  called  the 
parallel  law. 

Davies  and  Primrose  [21]  introduced  algebraic  expres- 
sions for  both  the  series  and  parallel  laws.  They  employed 
"Graph  Theory"  and  represented  a kinematic  chain  by  a coup- 
ling  graph.  Briefly,  any  body  is  represented  by  a vertex 
whilst  any  joint  is  represented  by  an  edge  in  the  coupling 
graph.  They  defined  as  the  Instantaneous  Screw  System 

(ISS)  of  the  joint  (edge)  connecting  the  two  bodies  (vertices) 
i and  j of  the  coupling  graph  G,  Fig.  2.8.  They  also  defined 

s9  as  the  ISS  of  the  complex  joint  connecting  the  two  ver- 
in 

tices  i and  n of  graph  G provided  by  all  vertices  and  coup- 
lings corresponding  to  i and  n.  Briefly,  they  expressed 
the  series  and  parallel  laws  as  follows: 
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Figure  2.7. 


Two  Joints  in  Parallel 
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Coupling  Graph  "G"  Representing 
Bodies  Connected  in  Series 


Figure  2.8. 
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The  Series  Law  (Fig.  2.8) 

For  any  coupling  graph  G that  consists  of  bodies 
(vertices)  i,  j,  . . .,  n connected  in  series,  and 
joints  (edges)  i j , jk,  . . . , mn  then  the  ISS  that 
represents  the  instantaneous  relative  motion  of  body  i 
with  respect  to  body  n can  be  expressed  as 

= J^.  + J^,  + . . . (2.29)* 

in  1]  mn 

The  Parallel  Law  (Fig.  2.9) 

If  the  coupling  graph  G is  the  union  of  coupling 
graphs  G^ , G2 , ...  that  have  only  the  vertices  i and  j 
in  common,  then 

S^.  = S^i.  n S^2  ...  (2.30)* 

13  13  13 


2.3.2  Instantaneous  Kinematics  of  Serial 
Manipulators 

The  series  law  (2.29)  is  now  applied  to  determine  the 
instantaneous  motion  of  body  3 relative  to  body  1 of  the 
three  bodies  which  are  connected  serially  by  turning  joints 
(Fig.  2.10) . 

The  instantaneous  motion  of  body  2 relative  to  body  1, 
and  of  body  3 relative  to  body  2 are  respectively, 

' -1  ^ *^2-2'  ^^2^-2  ' -2  ^ ■ 

motion  of  body  3 relative  to  body  1 is  given  by  the  twist 

= o)|^,  (=co[S  ; S ]),  where 


*The  sum,  "+" , or  joining  of  two  subspaces  Wi  and  W2  is  the 
space  formed  by  all  vectors  of  the  form  vi  + v.2 , where  Vi 
is  a vector  of  Wi  and  v_2  is  a vector  of  W2. 

The  intersection  "o"  of  two  subspaces  Wi  and  W2  is  the 
space  formed  by  all  vectors  that  belong  to  both  Wi  and  W2 , 
and  [22] 


dim(Wi+W2)  = dim(Wi)  + dim(W2)  - dim(Wir>W2) 


37 


j 


Figure  2.9.  Coupling  Graphs  Gi,  G2/.... 

Connected  in  Parallel 
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Figure  2.10.  Serial  Manipulator  with 
Revolute  Joints 
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/N 

^ ~ ~ ^2^2  (2.31) 

and  where 

toS  = + ^2—2 

(joS  = 0)^  (r  X S ) + CO  (r  x S ) (2.32) 

— o 1 —1  —1  2 —2  —2 

This  resultant  motion  is  not  a pure  rotation,  but  it  is  a 
combination  of  a pure  rotation  co[S  ; (S^“  hS ) ] , and  a pure 

translation  co[^  ; hS]  parallel  to  the  axis  of  rotation  [13]. 

In  general,  consider  a sequence  of  n bodies  connected 
serially  with  screw  pairs.  The  twist  representing  the  in- 
stantaneous motion  of  body  n (the  end-effector  of  a manipu- 
lator) relative  to  ground  can  be  expressed  as  the  sum  of 
the  twists  associated  with  each  of  these  n screw  pairs 
/V  n 

^ = a)|^=Zo).|^.  (2.33) 

i = l ^ ^ 


2.3.3  Reciprocity  of  Screws 

A very  important  concept  in  the  theory  of  screws  due  to 
Ball  [11]  is  the  concept  of  the  reciprocity.  It  establishes 
the  relationship  between  the  motion  capabilities  and  the 
constraints  acting  on  rigid  bodies. 

Consider  a wrench  F^^=(F2;C2)  acting  on  a body  con- 
strained to  move  on  a screw  $ =(S,;S  ,)  and  it  produces  a 
twist  (w^;y_^)  as  illustrated  in  Fig.  2.11.  The  virtual 
work  produced  is  given  by 


W = F . u + (jO  . C 
-2  ^1  -1  -2 


-Fo)(S  . S . S ) 

— 2 — ol  —1  — o2 


(2.34) 
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Figure  2,11.  Wrench  Applied  on  a Body 
Constrained  to  Twist 
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The  above  expression  of  the  virtual  work  can  be  expressed 
in  the  form 

W = Foj[  (h^+h^)  cos  ~ ^12  (2.35) 

where  a^^  mutual  perpendicular  distance  and 

the  angle  between  the  two  screw  axes,  respectively,  and  h^ 
and  h^  are  the  pitches  of  the  two  screws. 

If  the  body  is  in  equilibrium,  then  the  applied  wrench 
produces  no  work  on  the  body,  6W  = 0,  and 

F(i)[  (h^+h^)  cos  “ ^12  ^ (2.36) 

For  non-zero  F and  o),  the  two  screws  and 
reciprocal,  and 

(hi+h2)cos  " ^12  ^^12  ^ (2.37) 

Equation  (2.37)  can  be  expressed  in  the  alternative  form 

° io  = S.  . S ^ . S = 0 (2.38) 

This  type  of  inner  product  is  usually  called  the  reciprocal 
product  of  the  two  screws.  Ball  introduced  the  term  recipro- 
cal because  the  product  is  symmetrical  (a  wrench  applied 
about  cannot  produce  a twist  about  ^2^*  important 

to  recognize  that  no  matter  how  large  the  intensity  F of  the 
wrench  is,  there  can  be  no  motion  of  the  body.  Some  special 
cases  of  reciprocal  screws  are  considered  in  [9]. 

The  subject  of  reciprocal  screw  systems  and  the  corre- 
sponding degrees  of  freedom  have  been  studied  in  great  detail 
by  Ball  [11],  Dimentberg  [14],  Hunt  [3],  Waldron  [16],  Duffy 
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[9],  and  others.  The  most  important  result  concerning  the 
concept  of  reciprocity  is  that  a rigid  body  in  space  which 
can  twist  about  n independent  screws  (1  ^ n ^ 6)  has  a re- 
ciprocal screw  system  of  order  (6-n) ; i.e.,  it  is  constrained 
by  (6-n)  independent  reciprocal  wrenches.  It  can  thus  be 
concluded  that  a reciprocal  screw  system  elegantly  describes 
and  quantifies  the  nature  of  the  constraints  acting  upon  the 
body . 

2.3.4  Linear  Algebra  of  Screw  Systems 

Recently,  Sugimoto  and  Duffy  in  [23]  made  use  of  the 
linear  algebra  characteristics  of  screw  systems,  and  they 
defined  orthogonal  screws.  The  two  screws 


and  ^2  “ — 2 said  to  be  orthogonal  when  they  satisfy 

the  condition 


The  product  * is  called  the  inner  or  orthogonal  product  of 
a pair  of  screws  because  it  is  analogous  to  the  inner-dot 
product  of  a pair  of  vectors.  When  a pair  of  screws  satisfies 
(2.39),  then  they  cannot  be  linearly  dependent.  Two  screws 


where  a^  and  a^  are  non-zero  scalars.  When  (2.40)  can  only  be 
satisfied  by  a^  = a^  = 0,  the  two  screws  are  said  to  be  linear- 
ly independent. 


0 


(2.39) 


and  said  to  be  linearly  dependent  when 


(2.40) 
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It  is  important  to  recognize  that  there  is  a one-to-one 
correspondence  between  reciprocal  and  orthogonal  screws. 

If  a screw  is  reciprocal  to  a screw  system  and  there  is 
a corresponding  screw  ^ which  is  orthogonal  to  the  screw 
system,  the  two  screws  and  ^ are  related  by 

$ = T i (2.41) 

where  the  matrix  T is  in  the  form 


T 


0 0 0 I 1 0 0 

0 0 0 I 0 1 0 

0 0 0 I 0 0 1 

1 0 0 I 0 0 0 

0 1 0 I 0 0 0 

0 0 1 I 0 0 0 


(2.42) 


For  example,  a body  connected  to  ground  by  five  screws  has 

five  independent  freedoms  and  there  is  a single  screw  , 

(L  ,M  ,N  ; P ,Q  ,R  ) which  is  reciprocal  to  the  five-system, 
r r r r r r 

In  other  words  there  is  a single  constraint  acting  upon  the 
body.  It  can  be  stated  that  the  body  cannot  have  motion  about 
the  corresponding  orthogonal  screw 

It  can  be  concluded,  in  general,  that  orthogonal  screw  systems 
describe  the  unattainable  motion  of  the  body. 

The  well  known  Gram-Schmidt  orthogonalization  process, 
or  the  modified  Gram-Schmidt  process,  [22-24]  can  be  applied 
to  determine  a set  of  linearly  independent  screws  orthogonal 
to  a screw  system.  Some  other  analytical  approaches  to 
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determine  orthogonal  and  reciprocal  screws  are  discussed 
in  detail  in  [9,  23]. 

Since  there  are  a maximum  of  six  linearly  independent 
screws  in  three-dimensional  space,  then  sets  of  seven  or  more 
screws  are  linearly  dependent,  and 

n 


E 

j = l 


OJ  . 


0 


(2.43) 


for  n ^ 7.  The  above  equation  (with  n = 7)  can  be  expressed 
in  the  following  matrix  form 


where  (L^,M^,N^  ; P^,Q^,R^)  are  the  screw  coordinates  and 

the  u) ' s are  the  scalar  multipliers  associated  with  the  twists. 

Therefore,  form.ing  the  orthogonal  product  of  (2.43)  with 

each  of  the  n screws  in  turn  gives  a set  of  n homogeneous 

equations  in  the  scalars  oj  . It  follows  that, 

12  n 

the  necessary  and  sufficient  condition  that  n screws 

^1 , ^2'  are  linearly  dependent  is  that  the  Gram.ian 

of  these  screws  vanishes. 
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* ^2 * in 

i2  * ii  ia  * i-2  ^2  * in 


= 0 (2.45) 


Equations  (2.43)  and  (2.45)  are  used  in  Chapter  5 to  describe 
special  configurations  of  mechanisms. 


CHAPTER  3 

TYPE  SYNTHESIS  OF  MECHANISMS 

3 . 1 Definitions  and  Basic  Procedures 

Type  synthesis  (or  number  synthesis)  of  mechanisms 
provides  an  exhaustive  and  very  systematic  method  of  dis- 
covering, displaying,  and  evaluating  all  mechanisms  with 
a given  or  specified  overall  mobility  M. 

The  complete  process  of  type  synthesis  is  defined  to 
involve  the  determination  of : 

- Total  number  and  types  of  kinematic  pairs  (joints) . 

- Total  number  and  types  of  links. 

- Total  number  of  unique  kinematic  chains  that  can 
be  structurally  synthesized  using  the  total  number 
of  links  and  joints  (called  "Structural  Synthesis"). 

This  is  followed  by  the  determination  of  the  location  of  the 
actuated  kinematic  pairs  and  the  fixed  link  (the  frame)  to 
form  the  corresponding  mechanisms  or  devices  (sometimes 
called  the  "Motors"  mechanisms  [25,26]). 

A kinematic  chain  can  be  defined  simply  as  an  assem- 
blage of  links  and  pairs.  It  may  be  open  (unclosed)  or 
closed.  Every  joint-element  of  every  link  in  a closed  kine- 
matic chain  has  to  be  connected  to  at  least  one  other  joint- 
element  of  a neighboring  link.  A mechanism  can  be  formed 
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by  fixing  one  link  of  a corresponding  kinematic  chain.  The 
mobility  of  a mechanism*  may  be  defined  as  the  number  of 
independent  parameters  or  coordinates  necessary  to  locate 
each  link  relative  to  one  another. 

A kinematic  chain  is  said  to  have  total  mobility  M 
(see  [27-29])  when  it  can  fulfill  the  following  condition; 

"If  any  link  of  the  chain  is  selected  to  be  the  frame,  and 
any  M-links  are  chosen  to  be  independent  driving  links,  then 
the  position  of  every  remaining  (driven)  link  is  dependent  on 
the  position  of  all  M-driving  links."  This  means  that  in 
order  for  a kinematic  chain  to  have  a total  mobility  M, 
regardless  of  which  link  is  fixed  and  also  regardless  of 
which  pairs  are  to  be  actuated'^' , it  must  not  contain  within 
it  any  closed  kinematic  subchain  (closed-loop)  which  has  less 
than  M-degrees  of  mobility.  A kinematic  chain  which  cannot 
fulfill  the  above  condition  for  total  mobility  possesses 
either  a partial  or  fractionated  mobility  (see  Section  3.2 
for  more  details) . 

The  mobility  of  any  mechanism  can  be  determined  from 
the  general  mobility  equation 


*The  author  is  aware  of  a trend  to  abandon  the  difference  in 
definition  between  the  term  mobility  and  degrees  of  freedom, 
as  being  of  trivial  importance  and  to  use  the  symbol  M for 
mobility  or  degrees  of  freedom  of  a mechanism. 

■[■There  may  be  restrictions  on  which  M-pairs  can  be  used  as 
actuated  pairs  (inputs).  Davies  [26]  discussed  this  con- 
cept in  some  detail  for  kinematic  chains  which  do  not 
possess  total  mobility.  Also,  the  concept  of  motion  of  the 
actuators  being  instantaneously  dependent  is  discussed  in 
Chapter  5 of  this  text. 
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j 

M = d(N-j-l)  + E f. 

i = l 


(3.1)* 


where 


and 


M:  the  effective  degree  of  freedom  of  the  mechanism, 

d:  the  degree  of  freedom  of  the  space  in  which  the 

mechanism  operates  (the  order  of  the  correspond- 
ing screw  system),  i.e.,  d = 3 for  planar  and 
spherical  motions  and  d = 6 for  spatial  motions, 
in  general, 

f : the  degree  of  freedom  of  the  ith  kinematic  joint, 

Z f.t  the  number  of  effective  joint  freedoms, 

= 1 ^ 

N:  the  number  of  links, 

j:  the  number  of  kinematic  joints. 


In  order  to  apply  (3.1)  correctly,  it  is  necessary  to 
examine  the  types  of  kinematic  pairs  and  links.  In  the  first 
instance  only  revolute  or  turning  pairs  (R)  will  be  considered. 
A k-nary  pair  is  defined  as  a pair  or  joint-element  which  con- 
nects k-links  (see  Fig.  3.1)  and  it  should  be  clear  in  apply- 
ing the  mobility  equation  (3.1)  that  ternary,  quaternary, 

. . . pairs  counts  as  two,  three,  . . . pairs.  However, 
mechanisms  with  ternary,  quaternary,  . . . pairs  will  be 
excluded  from  this  text. 


*Equation  (3.1)  could  be  expressed  in  the  form 

M = d(N-j-l)  + ( Z f . ) - I, 
i = l -L  u 


where 

I^:  idle  or  passive  degree  of  freedom 

and  f^;  degree  of  freedom  of  the  ith  kinematic  pairs. 

Fig.  3.23  illustrates  some  connecting  chains  with  idle  free- 
doms. Each  idle  freedom  is  represented  by  a double-headed 
dotted  arrow. 
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binary  pair 


ternary  (double)  pair 


double  joint  version  of  Watt  mechanism 


Figure  3.1.  Types  of  Kinematic  Pairs  (Joints) 
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Any  mechanism  (see  [27]  and  [30])  comprised  of  simple 
revolute  pairs  for  which  fj^  = 1 must  have  a total  number  of 
links,  N,  and  a total  number  of  pairs,  j,  given  by: 


where  n^,  n^ , n^ , ...  are  respectively  the  number  of  binary, 

ternary,  quaternary,  ...,  etc.  links  (see  Fig.  3.2).  A 
P-nary  link  is  a polygon  of  P corners  or  joint-elements  to 
which  P links  are  connected. 

This  text  is  concerned  only  with  the  so-called  "Parallel 
Devices,"  (see  Chapter  1).  It  has  been  concluded  in  [2,3] 
that  no  conceivable  practical  advantage  is  seen  by  designing 
or  synthesizing  a "mixed-d"  device.  A "mixed-d"  device  could 
be,  for  instance,  a general  spatial  (d=6)  loop  with  planar, 
spherical  and  other  overconstrained  (d<6)  loops  joining  to 
it  and  moving  as  it  moves.  The  only  parallel  robotic  devices 
with  practical  promise  are  those  with  d = M = 3 (three-degree 
of  freedom  spherical  or  planar  devices — 3/3/second  and 
3/3/fifth,  respectively,  see  Table  3.1*)  and  d = M = 6 
(general  six-degree  of  freedom  spatial  devices) . 


N = n2  + n3  + 


(3.2) 


2j  = 2n2  + 3n3  + 


Z pn 
o P 

p=2 


(3.3) 


*This  table  is  adapted  from  Table  2 [2]. 
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n5  : quinary  link 


Figure  3.2.  Types  of  Links 
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Table  3.1 

Screw  Systems  Applicable  to  the  Practical 
Parallel  Robotic  Devices 


Order  of 

Identification 

Description  of  the  Screws 

the  Screw 

(Classification) 

of  the  System 

System 

(d) 

3 3/3/second  Screws  of  zero  pitch  along 

all  lines  throughout  a 
point,  namely  the  system 
applicable  to  spherical 
motion 


3/3/fifth  Screws  of  infinite  pitch 

along  all  lines  parallel 
to  a given  plane  together 
with  screws  of  a specified 
finite  or  zero  pitch  along 
all  lines  perpendicular  to 
the  plane,  this  system 
including  that  applicable 
to  planar  motion 

ALL  screws  of  all  pitches 
along  all  lines  in  all 
directions 


6 
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3.2  Type  Synthesis  of  Planar  Robotic 

Devices 

A type  synthesis  of  planar  devices  (for  which  d = 3) 
is  now  performed.  Firstly,  it  is  necessary  to  determine 
the  links  and  joints  which  can  be  assembled  to  form  a planar 
kinematic  chain  with  specific  mobility  M.  This  is  accom- 
plished using  (3.1)  which  reduces  to 

M = 3 (N-1)  - 2j  (3.4) 

It  can  also  be  rearranged  in  the  form 

M + 3 = 3N  - 2j  (3.5) 

Further  substituting  for  N and  j using  (3.2)  and  (3.3)  gives 

M + 3 = n - E (p-3) n (3.6) 

p=4  P 

It  is  clear  from  (3.6)  that  the  mobility  M is  indepen- 
dent of  the  number  of  ternary  links  n^  in  the  chain.  Con- 
sider that  an  N-link  kinematic  chain  is  found  which  contains 
n^  ternary  links  and  therefore  (N-n^)  of  the  other  types  of 
links.  It  follows  that  there  exists  other  kinematic  chains 
having  the  same  mobility  M and  the  same  number  of  each  link 
other  than  ternaries  and  which  contain  (n^+2k)  ternary  links 
where  k is  any  integer. 

At  the  outset  it  is  most  useful  to  be  able  to  select  a 
minimum  number  of  binary  links  for  a specified  value  of  M, 
and  it  follows  from  (3.6)  that  for  a closed  planar  kinematic 
chain 

(n_)  . = M + 3 (or  = 3N  - 2j)  (3.7) 

2 min 


54 


For  planar  kinematic  chains  with  M = 3,  equation  (3.4) 
can  be  rearranged  in  the  form 

j = I (N-2)  (3.8) 

Since  j must  be  an  integer,  then  N must  be  even.  Using  this 
simple  fact,  Table  3.2(a)  can  be  constructed.  Further, 
it  is  possible  to  change  the  number  of  any  three  successive 
types  of  links  from  n , n , n to  (n  ,+l) t (n-2) , 

^ p-1  P p+1  p-i  P 

(n  +1)  without  changing  the  total  number  of  links  or  joints, 

p+l 

or  the  mobility.  Therefore  using  equations  (3.2),  (3.3)  and 

(3.7),  and  by  successive  numerical  operations  of  this  sort. 

Table  3.2(b)  can  be  deduced  from  Table  3.2(a).  For  instance, 

group  I,  with  n^  = 4,  is  the  simple  serial  chain.  For  groups 

II,  Ill(a),  IV(a),  . . .,  the  minimum  number  of  binaries  is  6. 

Since  in  group  IV (a)  n^  = 6 and  n^  = 4;  therefore  group 

IV (b)  will  have  n^  =6+1=7;  n^  =4-2=2  and 

n.  = 0 + 1 = 1. 

4 

Having  determined  the  number  and  types  of  both  links 
and  joints,  it  remains  to  determine  all  the  possible  ways 
of  connecting  these  links  and  joints.  This  process,  which 
is  called  "Structural  Synthesis,"  is  accomplished  here  by 
introducing  Franke ' s notation  [29,31]; 

(i)  A circle  is  introduced  to  represent  each  polygonal 
link.  The  type  of  each  link  is  designated  by  placing  the 
so-called  valency  number  within  the  circle.  For  instance, 
a number  3 will  indicate  that  the  circle  is  describing  a 
ternary  link. 
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Table  3.2 

Structural  Analysis  of  M = 3 Planar 
Kinematic  Chains 


N 

4 

6 

8 

10 

12 

14 

J 

3 

6 

9 

12 

15 

18 

(b) 


Group 

j 

N 

>^2 

>^3 

^4 

^5 

^6 

^7 

^8 

I-a 

3 

4 

4 

Il-a 

6 

6 

6 

- 

- 

- 

- 

- 

- 

Ill-a 

9 

8 

6 

2 

b 

7 

0 

1 

IV-a 

12 

10 

6 

4 

« 

- 

- 

- 

b 

7 

2 

1 

c 

8 

0 

2 

d 

8 

1 

0 

1 

e 

9 

0 

0 

0 

1 

V-a 

15 

12 

6 

6 

- 

- 

- 

- 

b 

7 

4 

1 

c 

8 

3 

0 

1 

d 

8 

2 

2 

e 

9 

1 

1 

1 

f 

9 

0 

3 

0 

g 

10 

0 

0 

2 

h 

10 

0 

1 

0 

1 

i 

11 

0 

0 

0 

0 

0 

1 

Vl-a 

18 

14 

6 

8 

— 

- 

- 

- 

b 

7 

6 

1 

c 

8 

4 

2 

- 
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(ii)  A straight  line  is  introduced  to  represent  the  type 
of  connection  of  the  polygonal  links,  either  by  a joint  or  by 
one  or  more  binary  links  in  series . Each  straight  line  has 
also  an  associated  number  to  indicate  the  number  of  binary 
links  in  series,  or  zero  to  indicate  a direct  jointing. 

Table  3.3  illustrates  the  meaning  of  the  different  connec- 
tions by  which  two  polygonal  links  may  be  joined.  The  asso- 
ciated numbers  may  be  placed  adjacent  to  these  lines.  Since 
a ternary  link  has  three  joint-elements,  three  lines  should 
emit  from  the  circle  representing  a ternary  link.  Similarly, 
four  and  six  lines  should  emit  from  circles  representing 
quaternary  and  hexagonal  links,  respectively. 

It  remains  to  convert  the  molecules  obtained  above  into 
equivalent  kinematic  chains  and  then  into  the  corresponding 
mechanisms.  Because  the  above  method  gives  combinations  that 
cannot  be  used,  it  is  necessary  to  observe  the  following; 

(i)  A mechanism  has  partial  mobility  M if  the  position 
of  some  driven  links  depends  on  the  movements  of  only  a 
number  of  the  driving  links,  where  Mp  > M.  Figure  3.3 
illustrates  three  planar  mechanisms  each  having  mobility 
M = 3.  In  (a)  and  (b)  the  lamina  A has  three  degrees  of 
freedom  relative  to  the  frame,  i.e.,  its  connectivity 
equals  three.  However,  in  (c)  the  position  of  the  lamina 
A (as  well  as  the  other  driven  link  3)  depends  only  on  the 
two  driving  links  2 and  4 in  the  closed  loop  a-b-c-d-e 
which  has  mobility  Mp  = 2 . In  this  case  by  locking  the 
two  driving  links  2 and  4,  the  lamina  A and  link  3 will 
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Table  3 . 3 

Franke ' s Molecule  Notation 


Number  of  Molecules  Some  Connections  and 

Connections  Representation  Their  Molecules 
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(a) 


Figure  3.3.  Planar  Mechanisms  with  Three-Dof 
(a)  and  (b)  Total  Mobility  M=3 
(c)  Partial  Mobility  M=3 
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be  locked  also.  Therefore  the  mechanism  in  (c)  has  partial 
mobility  and  the  lamina  A has  just  two  degrees  of  freedom 
relative  to  the  frame.  Since  in  the  investigation  of  paral- 
lel robotic  devices  the  main  concern  is  the  movement  of  the 
lamina  which  has  the  end-effector,  therefore  devices  with 
partial  mobility  will  be  acceptable  as  long  as  the  position 
of  the  lamina  depends  on  all  the  M-driving  links  and  as  long 
as  the  device  does  not  contain  within  it  any  closed  loops 
which  has  mobility  < 1,  i.e.,  structures.  Figure  3.4 
illustrates  some  subassembly  structures  which  must  be  avoided. 

(ii)  Rosenauer  [32]  stated  that  for  mobility  M = 1 closed 
mechanisms,  the  maximum  number  of  joint-elements  attached  to  a 
single  link  must  not  exceed  half  the  number  of  links  in  the 
chain,  (P  < ^) • Generally,  it  could  be  concluded  that  the 
maximum  number  of  joint-elements  attached  to  a single  link  in 
a closed  mechanism  can  be  expressed  in  the  form 

N-M+1 


max  - 2 


(3.9) 
N-M+1 


If  a mechanism  possesses  at  least  one  lirik  with  P > „ 

then  it  may  be  divided  into  two  or  more  parts,  and  if  that 
link  is  selected  to  be  the  frame  then  no  driven  link  is  cap- 
able of  being  moved  by  all  the  driving  links.  Such  mechanisms 
possess  a fractionated  mobility  and  the  sum  of  the  mobilities 
of  all  parts  is  equal  to  the  mobility  of  the  whole  mechanism. 
For  instance,  for  the  three-degree  of  freedom  planar  mechanism 
in  Fig.  3.5(a)  P has  to  be  less  than  or  equal  (^^^  = 3). 


max 


= 4,  this  mechanism  has  two  conjoined 


However,  because  P 
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(a)  (0,0)  combination 


(b)  and  (c)  structural  triangles 


Figure  3.4.  Structures  which  Must  Be  Avoided 
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Figure  3.5. 


Mechanisms  Having 

(a)  Fractionated  Mobility 

(b)  Immobility 


Ttr 
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sub-assemblies  of  mobilities  M = 1 and  M = 2,  and  the 
lamina  A has  two  degrees  of  freedom  relative  to  the  frame. 
In  general,  mechanisms  with  fractionated  mobility  must  be 
avoided . 

(iii)  If  in  a mechanism  of  mobility  M,  a closed  kine- 
matic subchain  exists  of  mobility  less  than  the  number  of 
actuated  pairs  it  contains,  then  the  mechanism  is  immobile 
and  should  be  avoided  (see  Fig.  3.5(b)). 

It  could  be  concluded  that  the  kind  of  mobility  is  not 
a notion  inherent  in  any  kinematic  chain  and  it  is  subject 
to  change  by  the  choice  of  the  actuated  pairs  and  of  the 
frame.  However,  in  most  parallel  robotic  devices  the  actu- 
ated pairs  are  preferred  to  be  close  to  ground,  and  the 
main  concern  is  that  the  lamina  which  has  the  end-effector 
has  to  have  relative  mobility  equal  to  the  mobility  of  the 
whole  device  without  having  structures  within  the  chain. 
Such  devices  are  now  illustrated  in  Figs.  3.6-3.16. 

3 . 3 Type  Synthesis  of  Spatial  Robotic 

Devices 

For  spatial  kinematic  chains  (d  = 6,  in  general),  the 
mobility  equation  (3.1)  reduces  to 

M = 6 (N-1)  - 5j  (3.10) 

where  fj^  = 1.  Equation  (3.10)  can  be  rearranged  in  the 
form 


M + 6 = 6N  - 5j 


(3.11) 
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Figure  3.6. 


Group  I,  Open  Chain 
N=4,  n2=4,  j-3 
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Figure  3.7.  Group  II,  Single-Loop  Closed  Chain 
N=6,  n2=6,  j=6 


7777 
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(b)  partially-parallel  device 


Figure  3.8.  Group  III 

N=8,  U2=6,  H3=2,  j=9 


TfT 
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Figure  3.9. 


Group  IV-a 

N=10,  U2=6,  H3=4,  j=12 
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Figure  3.10.  Group  IV-b 

N=10,  n2=7,  U3=2,  H4=1,  j=12 
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.11.  Group  IV-c,  N=10,  n2 
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Figure  3.12.  Grouo  V-b,  N=12,  H2=7, 
n3=4,  H4=1,  j=15 
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Figure  3.13.  Group  V-c,  N=12,  n^=8, 

n5=l,  j=15 
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Figure  3.14.  Group  V-d,  N=12,  U2=8 
ns=2,  H4=2,  j=15 
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Figure  3.15.  Group  V-f,  N=12,  U2=9, 
U4=3,  j=15 
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22222 


Figure  3.16. 


Group  V-g,  N=12,  n2=10 
H5=2,  j=15 
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Further  substituting  for  N and  j using  equations  (3. 2) and 
(3.3)  gives 


M + 6 = n„  - ^ (4  p-6)n 

2 P 

p=3 


(3.12) 


As  it  has  been  mentioned  in  Section  3.2,  it  is  most  useful 
to  be  able  to  select  a minimum  number  of  binary  links  for  a 
specified  M,  N,  and  j.  It  follows  from  equation  (3.12)  that 
for  a single-loop  closed  kinematic  chain;  i.e.,  n =0  for 

p > 2, 


(n  ) = M + 6 

2 min 


(3.13) 


However,  unlike  the  planar  kinematic  chains,  the  mobility  M 

of  spatial  kinematic  chains  is  dependent  on  the  number  of 

ternary  links  n3 . Therefore  i^2^min  equal  (M  + 6) 

in  general.  By  inspection,  for  a specified  M,  N,  and  j,  the 

number  of  binary  links  is  minimum  when  the  chain  contains 

only  binary  and  ternary  links;  i.e.,  n =0  for  p > 3.  Then 

P 

equations  (3.2)  and  (3.3)  become 


and 


(n_)  . + n,  = N 

2 min  3 


2 (n  ) . + 3n.  = 2 j 

2 min  3 


(3.14) 


(3.15) 


Solving  the  above  equations  simultaneously  gives 

(^2)min  = 3N  - 2j  (3.16) 

which  agrees  with  equation  (3.7)  for  the  planar  devices,  and 
also 


(n  ) = 2 ( j - N) 

3 max 


(3.17) 
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For  spatial  kinematic  chains  with  mobility  M = 6, 
equation  (3.11)  can  be  rearranged  in  the  form 

j = I (n-2)  (3.18) 

Since  j must  be  an  integer,  then  N must  be  7 , 12,  17,  .... 
Using  equation  (3.18),  Table  3.4(a)  is  constructed  and  then 
using  equations  (3.2),  (3.3),  (3.16-3.18)  and  by  successive 

numerical  operations  (see  Section  3.2),  Table  3.4(b)  can  be 
constructed.  It  is  interesting  to  note  that  Table  3.4(b) 
could  be  derived  from  Table  3.2(b)  simply  by  changing  the 
values  of  (n„)  starting  with  (n^)  = 3N  - 2j  for  the  values 

of  N and  j from  Table  3.4(a).  All  other  types  of  links  are 
identical  to  those  in  Table  3.2(b). 

Following  the  procedure  described  in  Section  3.2, 
some  molecules  and  their  equivalent  devices  which  have 
practical  promise  are  illustrated  in  Figs.  3.17-3.22. 

3 . 4 Discussion  and  Future  Robotic  Applica- 
tions of  Parallel  Devices 

The  above  synthesis  has  been  performed  using  only  revo- 
lute or  turning  pairs  with  f^  = 1 (or  in  general  screw  pairs 
with  f^  = 1) , however  all  other  pairs  could  be  considered  as 
combinations  of  screw  pairs  with  certain  pitches.  The  argument 
for  coalescing  the  pairs  can  be  applied  easily.  For  instance, 
[RP]  and  [RRR]  joint  combinations  could  be  used  to  simulate 
[c]  and  [s]  pairs  respectively.  Figure  3.23  illustrates 
seven  possible  connecting  subchains  and  their  equivalent 
R-P  representations.  Connecting  subchains  (c) , (d) , and 
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Table  3.4 

Structural  Analysis  of  M = 6 Spatial 
Kinematic  Chains 


N 1 

7 

12 

17 

22 

27 

32 

J 1 

6 

12 

18 

24 

30 

36 

(b) 


Group 

j 

N 

^2 

^3 

"4 

^5 

^6 

^7 

^8 

I 

6 

7 

7 

II 

12 

12 

12 

Ill-a 

18 

17 

15 

2 

b 

16 

0 

1 

IV-a 

24 

22 

18 

4 

b 

19 

2 

1 

c 

20 

0 

2 

d 

20 

1 

0 

1 

e 

21 

0 

0 

0 

1 

V-a 

30 

27 

21 

6 

b 

22 

4 

1 

c 

23 

3 

0 

1 

d 

23 

2 

2 

e 

24 

1 

1 

1 

f 

24 

0 

3 

0 

g 

25 

0 

0 

2 

h 

25 

0 

1 

0 

1 

i 

26 

0 

0 

0 

0 

1 

Vl-a 

36 

32 

24 

8 

b 

25 

6 

1 

c 

26 

4 

2 

• 

30 

0 

0 

0 

2 
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Figure  3.17.  Group  I,  Spatial  Open  Chain 
N=7,  n2=7,  j=6 
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Figure  3.18. 


Group  II,  Single-Loop  Closed  Chain 
N=12,  n2=12,  j=12 


Figure  3-19.  Group  Ill-a,  N=17,  n2=15, 
U3=2,  j=18 
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Figure  3.20.  Group  IV-c,  N=22,  R2=20, 
n4=2,  j=24 
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Figure  3.21.  Group  V-g,  N=27,  n2=25, 
U5=2,  j=30 
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Group  VI,  N=32,  n2=30 
ng=2,  j=36 


Figure  3.22. 
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Figure  3.23.  Seven  Possible  Connecting  Subchains 
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(e)  have  five  freedoms  while  (f)  and  (g)  have  six  freedoms. 
Spin-freedoms  (idle-freedoms)  are  denoted  by  double-headed 
dotted  arrows. 

The  simplest  parallel  devices,  closed  single  loop 
devices  illustrated  in  Figs.  3.7  and  3.18,  have  a slight 
advantage  of  greater  rigidity  over  open  loop  serial  devices 
such  as  those  illustrated  in  Figs.  3.6  and  3.17.  However, 
because  of  the  symmetry,  high  rigidity,  and  high  precision 
positioning  of  the  device  illustrated  in  Fig.  3.8(a),  this 
device  is  considered  to  be  one  of  the  most  practical  planar 
devices.  This  particular  device  has  been  developed  by  the 
"Center  of  Intelligent  Machines  and  Robotics — CIMAR"  at  the 
University  of  Florida  [4].  As  discussed  in  Chapter  1,  the 
three  actuated  connecting  subchains  of  this  device  are  fully 
in-parallel  with  one  another,  and  the  device  is  considered  to 
be  a fully-parallel  planar  device.  Three  actuated  prismatic 
pairs  could  be  considered  instead  of  the  three  revolute 
pairs  R , R , and  R (see  Fig.  3.24  and  [2]). 

Figures  3.8(b)  and  3.11(b)  illustrate  two  examples  of 
the  so-called  "partially-parallel"  devices  (see  Chapter  1) 
in  which  the  actuated  connecting  subchains  are  connected 
partially  in-parallel.  These  type  of  devices  are  sometimes 
incorporated  in  earth-moving  machinery  (Fig.  3.25),  and  may 
also  have  been  adapted  in  some  specialized  robotic  devices. 
Also,  as  proposed  by  Hunt  [3],  a six-degree  of  freedom 
robotic  device  could  comprise  two  three-degree  of  freedom 
parallel  devices  connected  in  series.  Figure  3.26 
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Figure  3.24.  Alternative  Form  of  Figure 


Figure  3.25.  Planar  Earth  Moving  Machinery 


end-effector  platform 
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Figure  3.26.  Three-Degree  of  Freedom  Shoulder 
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illustrates  a possible  three-degree  of  freedom  shoulder  with 
three  linear  actuators. 

Most  observers  agree  that  symmetrical  fully-parallel 
devices  can  be  made  much  stronger  and  can  manipulate  heavier 
loads  more  precisely  within  their  working  volumes  than  their 
corresponding  serial  devices.  It  is  concluded  that  the 
devices  illustrated  in  Figs.  3.19  and  3.22  are  the  two 
spatial  devices  with  the  most  practical  promise.  Figure 
3.27  illustrates  a practical  design  based  on  Fig.  3.19. 

It  has  three  turning  actuated  pairs  at  the  base  followed  by 
three  linear  actuators.  Figure  3.28  [7]  illustrates  a 
practical  design  developed  by  the  CIMAR  research  group  at 
the  University  of  Florida  which  was  based  on  Fig.  3.22.  The 
well  known  "Stewart  Platform"  which  stems  from  Fig.  3.22  is 
illustrated  in  Fig.  3.29.  It  is  constructed  by  connecting 
two  hexagonal  links,  frame  and  platform,  to  six  adjustable 
subchains  (legs) . However,  Hunt  [2]  indicated  that  an 
arrangement  close  to  the  variable-edge-length  octahedron 
has  important  merits.  This  arrangement  is  another  version 
of  the  "Stewart  Platform."  The  six  adjustable  subchains 
(only  one  is  shown  in  full  in  Fig.  3.30)  are  distributed 
in  a triangular  pattern  around  two  ternary  links  using 
double-spherical  joints.  Further,  the  R-pair  in  series 
gives  the  arm  an  extra  rotary  freedom  relative  to  the  base. 
The  "Stewart  Platform"  type  of  device  was  originally 
designed  as  an  aircraft  simulator,  and  was  also  suggest- 
ed for  the  application  of  machine  tool,  space  vehicle 
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end-effector  platform 


Figure  3.27.  R-P-SP  Fully-Parallel  Device 
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end-effector 


Figure  3.28.  University  of  Florida  Concept  for 
Fully-Parallel  Robot  Device 
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end-effector  platform 


Figure  3.29.  Stewart  Platform 
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Figure  3.30.  Six-Degree  of  Freedom  Robot  Arm 
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simulator,  transfer  machine,  etc.  However,  recently  it  has 
been  adapted  as  a mechanism  for  robotic  uses  [2,3,33]. 

Another  application  of  the  concept  of  Fig. 3.22  is  the  so- 
called  "Pedipulators"  or  "Walking  Machines"  [34].  These 
devices  usually  form  a six-degree  of  freedom  spatial  device 
with  six-connecting  subchains  as  they  achieve  locomotion. 

As  the  pedipulator  walks  the  serial  open-loop  kinematic 
subchains  form  closed  subchains  with  the  earth  (see  Fig. 
3.31).  Some  other  applications  are  discussed  in  [4,6,35-37]. 
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Figure  3.31.  Kinematic  Representation  of  Walking  Machine 


CHAPTER  4 

INSTANTANEOUS  KINEMATICS  OF 
FULLY-PARALLEL  DEVICES 


4 . 1 Introduction 

The  instantaneous  kinematics  of  serial  kinematic  chains 
which  model  the  vast  majority  of  existing  industrial  robots 
has  been  studied  widely  using  a variety  of  techniques. 

The  instantaneous  kinematics  of  such  serial  devices  has 
been  described  elegantly  using  the  theory  of  screws.  How- 
ever, because  of  the  complexity  of  the  geometry  of  parallel 
devices  relative  to  the  geometry  of  serial  devices,  the 
analysis  of  parallel  devices  has  received  relatively  little 
or  no  attention.  This  chapter  together  with  the  subsequent 
chapter  is  devoted  to  establishing  analytical  procedures  for 
investigating  the  instantaneous  kinematics  of  fully-parallel 
devices  using  the  theory  of  screws. 

It  was  concluded  in  the  previous  chapter  that  there  is 
no  conceivable  practical  advantage  in  using  a "mixed-d" 
device.  Therefore,  the  instantaneous  kinematics  of  only 
parallel  planar  devices  (M=3)  and  parallel  spatial  devices 
(M=6)  is  studied  here.  It  was  also  concluded  in  Chapter  3 
that  parallel  devices  with  practical  promise  are  either 
fully-,  or  partially-parallel.  Further,  fully-parallel 
devices  can  be  classified  according  to  the  distribution  of 
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both  actuated  and  non-actuated  joints  into  "Symmetrical"  and 
satisfy  the  following  conditions: 

(i)  There  is  the  same  number  of  joints  in  each  subchain, 

(ii)  There  is  the  same  number  of  actuated  joints  in  each 
subchain. 

(iii)  The  location  of  the  actuators  in  each  subchain  is 
the  same . 

When  at  least  one  of  the  criteria  (i)-(iii)  is  not  satisfied 
the  device  will  be  called  "Asymmetrical." 

The  study  of  the  instantaneous  kinematics  of  kinematic 
chains  was  pioneered  by  Waldron  [20]  (see  also  Chapter  2)  when 
he  introduced  the  series  and  parallel  laws  of  instantaneous 
kinematics.  However,  Davies  and  Primrose  [21],  and  later 
Baker  [37]  pointed  out  that  the  series  and  parallel  laws 
were  insufficient  for  determining  the  relative  freedom  be- 
tween any  two  bodies  divided  by  cross- jointing . Figure  4.1 
illustrates  an  example  in  which  bodies  2 and  6 are  divided 
by  cross-jointing.  Davies  and  Primrose  [21]  and  Baker  [37] 
pointed  out  that  the  parallel  law  cannot  be  applied  in  this 
case  since  there  are  no  coupling  graphs  (see  Fig.  4.1(b)) 
that  have  only  vertices  2 and  6 in  common.  It  is  important 
to  recognize  that  the  graph  in  Fig.  4.1(b)  is  analogous  to 
the  Wheatstone  Bridge  which  is  neither  a series  nor  a paral- 
lel electrical  circuit  and  this  may  well  have  inspired 
Davies  to  apply  the  well-known  Kirchoff's  Circulation  Law  to 
mechanical  networks  [38]. 
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(b) 


Figure  4.1. 


Six-Bar  Planar  Mechanism  with 
Cross-Jointing 
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Because  Davies  and  Primrose  [21]  were  not  concerned  with 
the  magnitude  of  the  twists,  they  specified  a screw  by  its 
homogeneous  coordinates.  This  enables  them  to  represent  the 
screw  by  a point  in  five-dimensional  projective  space  (see 
Section  2.2.2).  Subsequently,  they  introduced  a new  theorem 
which  is  a generalized  version  of  the  Aronhold-Kennedy  theorem 
of  three  centers. 

Baker  [37]  made  use  of  motor  algebra  [10,39].  This 
enabled  him  to  specify  all  the  six-coordinates  of  a screw 
and  further  enabled  him  to  compute  the  relative  magnitude 
of  the  twist.  He  extended  the  notation  of  Davies  and 
Primrose.  He  defined  to  be  the  Instantaneous  Screw 
Axis  (ISA)  vector  corresponding  to  the  screw  system  of 
order  one  of  the  joint  between  bodies  1 and  2,  and  Sj^2 
to  be  the  resultant  screw  motor  (twist)  which  describes 
the  instantaneous  motion  of  body  2 relative  to  body  1.  He 
also  defined  (see  Fig.  4.1)  to  be  the  set  of  screws  gov- 

erned by  the  direct  jointing  of  bodies  1 and  4.  However,  he 
pointed  out  that  this  direct  jointing  may  well  place  a fur- 
ther constraint  on  the  relative  freedom  between  bodies  2 
and  6,  and  because  of  this  three  distinct  cases  may  arise: 

Case  (i)  : If 

■^14  ? <Jl2+'^24>  ^ 

then  the  direct  jointing  imposes  no  additional  constraints. 

The  series  and  parallel  laws  may  be  used  to  determine  the 
relative  freedom  between  bodies  2 and  6,  and 
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S = (J  +J  ) A (J  +J  ) 
26  24  46  ' ' 21  16 

Case  (ii)  : If 


^14  ^ (^12-^^24^  ^ (^16-^^64)  = ° 


(4.2) 


(4.3) 


then  the  three  subchains  between  bodies  1 and  4 result  in 
the  prevention  of  the  relative  motion  between  the  two  bodies. 
Therefore,  only  relative  motion  between  bodies  2 and  6 will 
be  due  to  part-chain  mobility  alone.  The  series  and  parallel 
laws  can  be  applied,  and 

S = (J  A J ) + (J  r\  J ) (4.4) 

26  ' 24  ' ' 21^  ' 46  16'  v**-**/ 


Case  (iii)  : 

When  neither  (4.1)  nor  (4.3)  is  satisfied  then  Baker  pointed 

out  that  the  series  and  parallel  laws  were  insufficient  to 

determine  the  relative  motion  of  bodies  2 and  6 but  only 

infer  upper  and  lower  bounds  for  S . Subsequently,  he  intro- 

duced  an  algebraic  procedure  which  is  equivalent  to  the 

theorem,  introduced  by  Davies  and  Primrose  [21].  However, 

this  procedure  is  complicated.  Firstly, he  computed  S using 

2 6 


''26  = <■^24  ^ ^ <^6^"l6'*S26 


(4.5)* 


where  (J24'^'^2l^  ^'^46^'^16^  screw  system  represent- 

ing the  relative  motion  of  bodies  2 and  6 when  bodies  1 and  4 


*The  author  in  [37]  used  the  union  " \J  " instead  of  the  sum  or 
join  "+"  in  (4. 1-4.5)  and  used  "(p"  (empty  set)  instead  of 
the  in  (4.3)  which  are  not  correct.  The  sum  or  join  of 

two  subspaces  is  always  a subspace  but  the  union  is  a sub- 
space if  and  only  if  one  of  the  subspaces  is  contained  in 
the  other,  which  is  not  the  case  here,  in  general.  The 
intersection  of  subspaces  is  not  the  empty  set  but  is  a 
subspace  which  contains  at  least  the  zero  vector. 
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are  fixed  (see  case  (b)  above).  Then  he  defined  S^g  to  be 
a restricted* *  set  of  screws  which  governs  the  relative  motion 
between  bodies  2 and  6 in  a way  which  is  compatible  with  the 
relative  motion  between  bodies  1 and  4. 

In  order  to  determine  S , the  twist  S representing 

26  —14 

the  motion  of  body  4 relative  to  1 has  to  be  determined  from 
the  following  three  equations 


1 

‘^12-12 


, . D T 3 
24-24 


= I 


^^4i^4 


E 

k 


k -rk 

“14^14 


n 

14 


I “16^16  * ^ “64^64  - ^14  - ^ “x4il- 
£ m n 


(4.6) 


In  (4.6)  the  superscripts  represent  in  general  the  order  of 

the  screw  systems.  Using  (4.6)  the  base  screw  vectors 

^14'  ’ ' ^^4  can  be  determined  and  all  the  twist  magnitudes 

i "1  Ic  m 

(4,^,  bit,,  (4,^,  (4,^  and  (4^^  can  also  be  determined  in  terms 
12'  24'  14  16  64 

of  the  magnitudes  of  fi?..  Once  (4^^,  (4^^,  . ..  (4^.  have  been 
^ 14  12  ' 24  ' 64 

determined  then  it  is  possible  to  determine  the  base  screw 

, ' r I ' 

vectors  ^ of  $ from  the  following  set  of  equations 


V D-rl  V m^m  „_,'rx'r 

^ ^ ^64^64  = ^ ^26^26 


24-24 


? ‘^12-12  ^ ^16'^16  ^ ^26^26 
1 £ r 


(4.7) 


I 

*S2g  is  not  an  ordinary  screw  system  because  it  is  spanned 
by  only  certain  prescribed  combinations  of  individual  screws 
rather  than  by  arbitrary  combinations  of  them. 
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* 3T 

where  the  magnitudes  of  will  be  expressible  ultimately 

2 6 

in  terms  of  the  . 

1 4 

Summarizing,  using  Baker's  procedure,  it  is  necessary 
to  identify  which  of  the  cases  (i) , (ii) , or  (iii)  a mech- 
anism belongs  to. 

Recently,  Davies  [38]  avoided  this  problem  by  develop- 
ing a constraint  law  for  a mechanical  network  which  is 
analogous  to  Kirchhoff's  Circulation  Law. 

Kirchhoff's  voltage  law  states  that 

[b]{v}  = 0 (4.8) 

where  [b]  is  the  circuit  matrix  (see  Fig.  4.2)  and  the  vol- 
tage v^  is  associated  with  edge  i.  By  analogy  Davies  ex- 
pressed the  constraint  law  for  a kinematic  chain  in  the  form 


B S ^ 

V , e e , 6 


0 

V , 


6 


(4.9) 


where,  B (=[b]),  is  the  circuit  matrix  which  has  v rows, 

(number  of  independent  loops)  and  e columns,  (number  of 
edges),  and  S is  a matrix  which  has  e rows  and  six  columns. 

6 , D 

Each  row  is  a twist,  and  the  matrix  S ^ can  be  replaced  by 
the  product  ip  S where  ip  is  a diagonal  matrix  contain- 

Q f Q G f O Q f G 

A 

ing  the  e scalars.  Each  row  of  S ^ is  a unit  screw.  The 

e , 6 

set  (4.9)  consists  of  6v  simultaneous  linear  equations  in  e 
unknowns  which  can  be  expressed  in  the  matrix  form 


C lii  =0 
6v,e  e,l  6v,l 


(4.10) 


where  ^ is  defined  as  the  constraint  matrix,  and  (4.10) 

is  defined  as  the  constraint  equation.  The  constraint 
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(a) 


A 

B C 

D 

c 

1 

I -1 

0 

0 

PJ- 

0 

m 

-1  0 

1 

-1 

Figure  4.2.  Directed  Graph  and  Its  Circuit  Matrix 
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equation  (4.10)  is  transformed  into  the  canonical  form 


0 


6v , 1 


(4.11) 


The  unknowns  in  the  vector  ip  in  (4.10)  are  separated  in 

6^1 


(4.11)  into  r secondary  (dependent)  coordinates  (j)^  ^ that  can 


be  expressed  in  terms  of  the  remaining  F primary  (generalized) 
coordinates  , , where  r is  the  rank  of  , and  F (F=e-r) 

is  the  degree  of  mobility*.  Solving  (4.11)  in  terms  of  these 
F known  coordinates  gives 


necessary  to  select  any  path  in  the  directed  graph  "G"  from 
i to  j and  sum  the  screw  motors  (twists)  associated  with  these 
joints  corresponding  to  the  edge,  taking  into  consideration 
the  orientation  of  these  edges. 

In  this  chapter  two  novel  procedures  are  presented  for 
determining  the  instantaneous  motion  of  the  end-effector  plat- 
form of  fully-parallel  devices.  The  initial-  or  first  procedure 
was  obtained  by  determining  explicit  expressions  for  the  un- 
known scalar  multipliers,  of  the  twists  associated  with 

the  joints  in  one  of  the  subchains  connecting  the  end-effector 

*Here  it  is  preferable  to  follow  the  same  notation  used  in 
[38].  However,  in  Chapter  3,  the  symbol  M rather  than  F 
was  used  to  denote  mobility  and  M will  be  used  throughout 
the  remainder  of  this  text. 


(4.12) 


Therefore  in  order  to  find  Davies  indicated  that  it  is 
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to  the  base  using  loop  velocity  equations.  At  the  outset  the 
objective  was  to  provide  an  alternative  improved  procedure  to 
that  presented  by  Davies  [38]  for  analyzing  the  instantaneous 
kinematics  of  platform-type  devices.  However,  further  investi- 
gation led  to  yet  another  procedure  for  which  the  instantaneous 
motion  of  the  end-effector  is  expressed  directly  in  terms  of 
the  known  input  scalar  multipliers  (the  magnitudes  of  the 
twists  associated  with  the  input-actuated  joints) . 

Further,  both  procedures  yield  a novel  and  important 
theorem;  "For  any  parallel  device  the  twist  representing  the 
instantaneous  motion  of  the  end-effector  platform  is  equal  to 
the  sum  of  its  partial  twists. " A partial  twist  is  defined 
as  the  twist  representing  the  instantaneous  motion  of  the  end- 
effector  when  all  but  one  of  the  input  actuators  are  locked. 

The  author  believes  that  this  result  provides,  in  general,  a 
proper  foundation  for  the  investigation  of  special  configura- 
tions of  fully-parallel  devices  for  which  the  screw  system 
degenerates  and  the  end-effector  loses  one  or  more  degrees  of 
freedom  (see  Chapter  5) . 

4 . 2 Instantaneous  Kinematics  of  the  End- 

Effector  of  Fully-Parallel  Symmetrical 
Devices  Using  Loop  Velocity  Equations 

4.2.1  Basic  Equations 

Figure  4.3  illustrates  an  end-effector  platform  of  a 
general  fully-parallel  symmetrical  device.  The  end-effector 
is  connected  to  the  base  by  N connecting  subchains.  Each  sub- 
chain consists  of  M joints,  where  M is  the  mobility  of  the 
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Figure  4.3. 


General  Fully-Parallel  Symmetrical  Device 
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end-effector  and  it  is  either  3 for  planar  devices  or  6 for 
spatial  devices  (see  Chapter  3) . In  order  for  the  end- 
effector  to  have  mobility  M,  the  number  of  input-actuated 


it  is  obvious  that  the  number  of  connecting  subchains,  N, 
has  to  equal  3 for  symmetrical  planar  devices  and  equal 
2,  3,  or  6 for  symmetrical  spatial  devices.  For  example, 
when  M = N = 6 then  there  is  one  actuator  in  each  subchain. 

It  has  been  indicated  in  the  previous  chapter  that  there  may 
be  restrictions  on  which  M joints  can  be  used  as  actuated  joints 
but  for  the  sake  of  simplicity  and  without  loss  of  generality 
the  actuators  will  be  assumed  to  be  located  at  the  base*. 

In  what  follows  it  is  convenient  to  choose  a single  sub- 
chain and  call  it  the  first  subchain.  It  could,  of  course, 
be  any  subchain  in  the  device.  This  subchain  will  be  labelled 
with  the  superscript  (1) . The  remaining  subchains  will  be 
labelled  with  the  superscript  (i) , (i=2 , 3 , . . . ,N) . There  are 

a total  of  (N-1)  independent  closed  loops  in  the  device  which 
contain  the  first  subchain,  and  the  set  of  loop  velocity  equa- 
tions for  those  (N-1)  independent  loops  can  be  expressed  in 
the  form 


24 

joints,  g,  in  each  subchain  is  given  by  g = — . Therefore 


K 'i;  ' + < 


(Did) 


(Did) 


+ . . . + (a) 


(4.13) 


*Also  for  practical  reasons  it  is  preferable  to  locate  the 
actuators  at  the  base  joints. 
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The  set  (4.13)  can  be  expressed  in  the  abbreviated  form 


M M . , 

Z (CJ  - I = 0 (4.14) 

: = i ^ j = i ^ 

/\ 

where  i = 2,  3,  . . . , N.  Further,  the  twist  (=  to  |^)  , rep- 
resenting the  instantaneous  motion  of  the  end-effector  can  be 
expressed  as  a linear  combination  of  the  joint  velocities  in 
the  first  subchain. 


^ = 0)  ^ 


i 


to. 


t 


+ to 


(1)^(1) 


M 


-HVI 


(4.15) 


Two  solutions  of  the  loop  velocity  equations  (4.14)  and 
the  twist  equation  (4.15)  will  be  presented.  Firstly,  it  will 
be  assumed  that  scalar  multipliers  of  the  twists  of  the  input 
joints  are  known  and  that  it  is  required  to  determine  the  twist 
^ of  the  end-effector.  This  will  be  called  the  forward 
solution.  Secondly,  it  will  be  assumed  that  the  twist  ^ of 
the  end-effector  is  specified  and  that  it  is  required  to  com- 
pute the  scalar  multipliers.  This  will  be  called  the  reverse 
solution . 


4.2.2  Forward  Solution 

For  the  forward  solution  let  and  where 

m m 

m = 1,  2,  . . .,  g and  i=2,  3,  ...,N,  denote  the  M known 
scalar  multipliers.  For  example,  when  M = N=  6 then  g = 1 
and  the  known  scalar  multipliers  will  be  u and 
where  i=2,  3,  ...,  6.  When  M = 6 , N = 3 then  g = 2 and 
the  known  scalar  multipliers  will  be  and 

0)2^^  where  i = 2,  3.  Further,  there  are  (M-g)  unknown 
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scalar  multipliers,  where  j = (g+1) , (g+2) , . . M 

j 

which  are  common  to  all  the  (N-1)  equations  in  the  set 
(4.14).  Also  there  are  (M-g)  unknown  scalar  m.ultipliers 

(i=2,  3,  ...,  N)  , in  each  equation  which  are  not  con- 

tained in  the  remaining  equations.  It  is  necessary  to 
eliminate  these  (M-g)  unknown  scalar  multipliers 
This  is  accomplished  by  determining  g screws  which  are 
orthogonal  (or  reciprocal)*  to  the  (M-g)  screws,  in 

each  one  of  the  independent  loops.  These  g screws  will  be 
denoted  by  where  L =1,  2,  ...,g  and  i = 2,  3,  ...  N. 

Taking  the  inner  product  of  each  orthogonal  screw  with 

the  corresponding  equation  in  the  set  (4.14)  gives  (M-g), 

(=  g(N-l)),  equations  which  are  linear  in  the  (M-g)  unknown 
scalar  multipliers  where  j = (g+1),  (g+2),  . . . ,M.  This 

set  of  equations  can  be  arranged  in  the  form 


($(1)  ) + 
g + 1 ^g  + l 


- *^j^h  + . . . + *^j^M ] 

+ + . . . + 

(4.16) 

where  i = 2,  3,  ...,N,  and  L = 1,  2,  ...,g.  The  set  (4.14) 

can  be  expressed  in  the  abbreviated  form 


*As  discussed  in  Chapter  2,  there  is  a one-to-one  correspon- 
dence between  orthogonal  and  reciprocal  screws  (see  equations 
(2.41  and  2.42)) . Therefore,  throughout  this  chapter  along 
with  the  subsequent  chapter  the  words  orthogonal  and  recipro- 
cal can  simply  be  interchanged  and,  of  course,  with  modifying 
phrases  to  make  the  statements  sensible. 
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M 

E 

j = g+l 


(i) 

oL 


) 


The  left  side  of  (4.17)  contains  the  unknown  scalar  multi- 
pliers where  j = (g+1)  , (g+2)  , . . M and  the  right 

side  contains  the  known  scalar  multipliers  and 

m m 

m=l,  2,  g.  The  set  (4.17)  can  be  written  in  the 

matrix  form 

[A]{oa*'^^  } = [b]{oj^^^  } (4.18) 

where  [a]  is  a square  [ (M-g)  x (M-g) ] matrix  which  is  a 
function  of  the  inner  products  (i.e.,  it  is  a function  only 
of  the  configuration  of  the  device) , 
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[A]  = 


ig+1  ^1 

• • • 

* • Xol 

^g+1  ^o2 

^g+2  ^o2  • ’ • 

^g+1  ^g 

• • • 

^g+2  ^g 

^g+1  ^1 

• • 5.M  £ol 

ig+l  iog 

^g  + 1 ^1 

• • • 

■ • 

^g+1  ^g 

*(l)*i(N)  ^ ^ ^ 

^g  + 2 ^g 

i(l)*i(N) 

’ * % ^g 

(4.19) 


[b]  is  a [(M-g)x(M)]  matrix  which  is  also  a function  of 
position , 


[B]  = 


®12  I ®22 


-B 


-B 


13 


14 


-B 


IN 


0 B33  0 


0 B 


44 


0 

0 


®(N-1)(N-1)  ° 


B 


NN 


0 


(4.20) 


Ill 


where  Bij  is  a [gxg]  matrix  such  that 


Bij  = 







1.1  iog  ^2  ig  iog  , 


(4.21) 


for  i = 1,  2,  . . .,  N and  j=2,  3, 

{o)^^^}  is  a [(M-g)xl]  column  vector  representing  the 
unknown  scalar  multipliers  in  the  first  subchain, 


{o)  } - o)g+2 


( 1)  tT 

0) 

M 


(4.22) 


and  is  a [MxI]  column  vector  representing  the  known 

scalar  multipliers. 


{O)' 


, to 


(1)  ,,(2) 


to. 


(4.23) 

2 g 


Further,  since  matrix  [a]  is  nonsingular  in  general,  when  the 
device  is  not  in  special  configuration  (see  chapter  5),  (4.18) 
can  be  expressed  in  the  form 


} = [k.  .Kto*-^^  } (4.24) 

J ^ 

where  Z = 1,  2,  . . . , M,  j = (g+1) , (g+2) , . . . , M,  and 

[k^^]  is  a [(M-g)xM]  matrix  which  is  also  a function  of 
position. 
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[K.,]  = 


^(g+l)l  ^(g+l)2 

^(g+2)l  ^(g+2)2 


K 


Ml 


K 


M2 


K 


K 


(g+l)M 

(g+2)M 


K 


MM 


(4.25) 


Expanding  (4.24),  explicit  expressions  for  the  unknown  scalar 
multipliers  can  be  expressed  in  the  form 


= [K  + K + 

J J 1 1 j2  2 


+ K.  0)^^^  ] 
Jg  g 


+ Fk  + K + 

•-^j(g+l)‘^l  ^ ^j(g+2)‘^2 


• . / r)  \ ^ J 

j(2g)  g 


* + . . . (4.26) 


(N) 


The  twist  $ representing  the  end-effector  can  be  determined 
by  substituting  (4.26)  in  (4.15)  and  hence 

CD  = Z + Z K. 

m=l  J=g+1 


^ 2 m ^ rn 

+ Z Z cd'-^^  Z K.  r ^ 
i=2  m=l  “ j=g+l  3 


(4.27) 


Further  examination  of  (4.27)  provides  an  alternative  form 
and  an  important  result  is  deduced  which  will  now  be  dis- 


cussed in  detail. 
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4.2.3  The  Concept  of  Partial  Screws 

Equation  {A. 21)  can  be  written  in  the  following  form 

I = co|  = coj  ^[i{  ^ S K ] 

j=g+l  ^ ^ 


...  + CO 


N 


(1) 

M 

+ E 
j = g+l 

K 

J 2^j 

.(1) 

M 

+ E 

K.  if 

-g 

j=g+l 

J g^3 

(1) 


+ Z {[ 


0) 


(i) 


M 


i-2  -1 


rn  ^ 

^^^2  j=g+i^j  [2+g(i-l)]^j  ^ 


M 


. . . + Z K . . . . if  } 

s j=g+i 


(4.28) 


Consider  now  that  all  the  input  actuators  are  locked  except 
the  actuator  at  the  first  base  joint  in  the  first  subchain, 
i.e.,  = co^^^  . . . = co^^^  = 0,  and  cof^^  = co^^^.  . .=u)^^^=0. 

The  instantaneous  motion  of  the  end-effector  is  due  solely  to  the 
twist  The  twist  representing  this  instantaneous 

motion  will  be  labelled  (=  will  be  defined 

as  the  partial  twist  due  to  the  input  twist  Equation 

(4.28)  reduces  to 

i<;)  = .<;>!<;>  = (4.29> 

j=g+i  J J 

Similarly  the  partial  twist  (=“p2^ip2^),  representing  the 

instantaneous  motion  of  the  end-effector  due  to  the  input 
twist  (^2 ^^^2^^  given  by 
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i- 


(1)  _ , (Did)  _ , (Dpid) 


/O’) 

Also,  the  partial  twist  representing  the  end-effector 

instantaneous  motion  due  to  the  input  twist  ^ is 

given  by 


■P2  = “P2'ip2'  = “^'[^'2'  + . 

J=g+1 


(4.30) 


x(2)  _ , (2)x(2)  _ , (2)  XV 

ipi  - “pi  ipi  -“1  j.^^.Dus+11  t 


M 


(D 


(4.31) 


Generally,  the  partial  twist  representing  the  instantaneous 
motion  of  the  end-effector  due  to  the  input  twist 

m 

can  be  expressed  in  the  form 


^ ^(D^(D  ^ o)d)^i(D  + X K (4.32) 

j=g+l 

and  the  partial  twist  representing  the  instantaneous  motion 
of  the  end-effector  due  to  the  input  twist  ^ for 

i = 2,  3,  . . .,  N,  can  be  expressed  in  the  form 

‘;<i)  = . ,.,(1)  " ^ *(1) 


M 


^pm 


pm  ^pm 


m 


K 


J = g+1 


j [m+g ( 


i-D]^j 


(4.33) 


Introducing  this  notation,  equation  (4.28)  can  be 
expressed  in  the  form 


pi  ^pi 

p p ... 

p2  3lp2 

+ 

.(d 

Pg 

^pg 

+ 

t o)(2)^(2) 
pi  ^pl 

p P ... 

+ 

(2) 

0) 

+ 

p2  ^p2 

pg 

^pg 

p ...  + 

pi  ^pl  p2  ip2 

+ 

(N) 

0) 

pg 

ppg 

(4.34: 


Finally,  equation  (4.34)  can  be  expressed  in  the  abbreviated 


form 
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N g 

^ = 0)  ^ = E E 
i=l  m=l 


(4.35) 


The  twist  representing  the  instantaneous  motion  of  the  end- 
effector  is  therefore  the  sum  of  all  partial  twists.  A 
partial  twist  is  defined  as  the  twist  representing  the 
instantaneous  motion  of  the  end-effector  due  solely  to  a 
single  input  actuator. 

For  a six-degree  of  freedom  spatial  device  (d=6) , the 
right  side  of  (4.35)  will  contain  six  partial  screws.  When 
the  right  side  of  (4.35)  contains  less  than  six  independent 
partial  screws,  then  the  end-effector  will  belong  to  a five- 
system  or  less.  Therefore  it  appears  that  equations  (4.18) 
and  (4.35)  will  provide  the  geometrical  conditioning  and  a 
proper  base  for  investigating  special  configurations  of 
fully-parallel  devices. 


4.2.4  Reverse  Solution 

The  twist  representing  the  instantaneous  motion  of  the 
end-effector  which  is  now  specified  was  expressed  as  a linear 
combination  of  the  joint  twists  in  the  first  subchain  (see 
(4.15)).  Clearly  the  twist  can  be  expressed  as  a linear 
combination  of  the  joint  twists  in  any  subchain  and  thus 


^ = (X) 


(i) 


+ 0) 


M 


(i) 

•M 


(4.36) 


where  i=l,  2,  ...,n,  ...orN. 

It  is  required  to  compute  the  g scalar  multipliers  of 
the  twists  of  the  g input  actuated  joints  in  each  subchain. 
This  is  accomplished  by  forming  in  turn  g screws  each  of 
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which  is  orthogonal  to  all  screws  in  the  subchain  except  one 
of  the  input  screws  in  the  subchain.  Consider  for  example 
that  g = 2 in  the  nth  subchain  where  and  ^2^^  are  the 

two  input  screws.  It  is  possible  to  determine  two  screws 
and  §^2^  which  are  orthogonal  to  the  screws 


ra,(n)  x(n) 

and  , 1.3^^  , . . 

*(n)  1 

respectively. 

Taking  the 

orthogonal  product 

of  the  left 

and  right  side 

of  (4.36) 

for  i = n with 

and  ^2^  / and 

solving  for  and 

gives 

,,(n)  = 

(4.37) 

x(n)  *<t;(n) 

iol 

and 

(n) 

(iO  _ 

(4.38) 

2 

Generally,  any  unknown  scalar  multiplier  can  be 

m 

computed  using  the  expression 


^ ( i) 

( ■ \ 

( 1 ) ^ m 

^ 7— 


(4.39) 


where  i=l,  2,  ...,N,  m=l,2,  ...,g,  and  is  a 

screw  which  is  orthogonal  to  all  screws  in  the  ith  subchain 
except  • 
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4.2.5  Instantaneous  Kinematics  of  the  End- 
Effector  of  a Six-Degree  of  Freedom 
Fully-Parallel  Symmetrical  Device 
with  Three  Connecting  Subchains  to 
Platform 


The  instantaneous  kinematics  of  the  end-effector  of  a 
six-dof  fully-parallel  symmetrical  device  with  three  connect- 
ing subchains  to  the  platform  (N=3  and  M=6)  is  now  investi- 
gated in  detail  using  the  loop  velocity  equations  method 
described  in  the  previous  sections.  The  instanteous  kine- 
matics of  the  end-effector  of  six-dof  fully-parallel  sym- 
metrical devices  with  six,  three,  and  two  connecting  subchains 
are  investigated  in  sections  4. 3. 5.1  - 4. 3. 5. 3 using  the 
shorter  direct  method  of  analysis  together  with  an  investiga- 
tion of  the  instantaneous  kinematics  of  a fully-parallel 
planar  device  which  is  given  in  section  4.3.6. 

In  order  for  the  end-effector  in  Fig.  4.4  to  have 

M 

mobility  M = 6,  there  are  two  input  actuators,  (g  = — = 2) , 
in  each  subchain  which  is  assumed  to  be  located  at  the  first 

two  joints  from  the  base  of  each  subchain,  i.e., 

(2)  (2)  (3)  (3) 

, and  o)^  are  the  six  known  scalar  multipliers. 

There  are  two  independent  loops  which  contain  the  first  subchain. 

The  set  of  two  loop  velocity  equations  for  these  two  independent 

loops  can  be  expressed  in  the  form 


0 


(4.40) 
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end-effector  platform 


Figure  4.4. 


Six-Degree  of  Freedom  Fully-Parallel 
Symmetrical  Device  with  Three 
Connecting  Subchains  to  Platform 


119 


For  the  forward  solution,  the  six  input  scalar  multi- 
pliers are  specified.  There  are  four  (M-g  = 6-2  = 4)  unknown 

scalar  multipliers  and  which  are  common 

3 4 5 6 

to  the  two  equations  in  (4.40).  Also  there  are  four  unknown 
scalar  multipliers  in  each  equation  which  are  not  contained 
in  the  other;  i.e.,  and  are  contained 

o 4 D 6 

in  the  second  equation  but  not  contained  in  the  first  equa- 
tion of  (4.40).  In  order  to  eliminate  those  four  unknowns 
in  each  equation,  it  is  necessary  to  determine  screws 
and  ^2^  orthogonal  to  the  set 

and  to  determine  screws  and  orthogonal  to  the  set 

f Taking  the  orthogonal  product 

then  of  ^^2^  with  the  first  equation  of  (4.40), 
the  orthogonal  product  of  and  then  of  with  the 

second  equation,  gives  four  equations  which  are  linear  in 
the  four  unknowns  and  . This  set  of 

four  linear  equations  can  be  written  in  the  following 


matrix  form: 
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Further,  since  the  square  matrix  on  the  left  side  of  (4.41)  is 
non-singular,  in  general,  then  (4.24)  reduces  to 


p" 

'^31 

^32 

K33 

^34 

^35 

^36 

^2 

^43 

^4 

^4  5 

^6 

^51 

^52 

K53 

^54 

^55 

^6 

^2 

\3 

^64 

^65 

^66 

0) 


CO 


CO 


CO 


CO 


(1) 

1 

(1) 

2 

(2) 

1 

(2) 

2 

(3) 


(4.42) 


Expanding  (4.42),  explicit  expressions  for  the  unknown  scalar 
multipliers  j ^ ^ / where  j = 3,  4,  5,  6,  can  be  determined. 
Equation  (4.26)  reduces  to 

(1)  _ , (1)  (1).  , (2)  (2) 

CO.  — (K.,co,  + K.„co„  ; + (K..,co.  + K.,co„  ) 

3 jll  j22  j31  j42 


+ (K.  co{^^  + K.  co^^^ 
j 5 1 j 6 2 


(4.43) 


The  twist  ^ representing  the  instantaneous  motion  of  the  end- 
effector  can  be  expressed  in  the  form 


i = coi  = t t . 


‘^6  h 


(4.44) 

Finally  substituting  (4.43)  in  (4.44),  ^ can  be  expressed  in 


the  form 
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i = + I K 1^^]  + + E K i?^^] 

j=3  j=3 


" j3<='j(21-l)i"’>^  “2'*  3V"i(2i)ij' 


(1) 


)} 


(4.45) 


Now  consider  that  all  actuators  are  locked  except  the 

( ) 

actuator  at  the  first  base  joint  in  the  first  subchain,  0^2''  = 
(jjp^=(jj2^^=0  and  ^ 0*  The  instantaneous 

motion  of  the  end-effector  is  due  solely  to  the  input  twist 
(l)<t(l)  n,u ...I  ......  J(l) 


CO 


The  partial  twist  ^ representing  this  instan- 


V JL ; <t 

1 - -p. 

taneous  motion  will  be  expressed  as  follows: 

^pi  pi  ^pi  1 ‘■^1  ji-^j 


(4.46) 


If  all  actuators  are  locked  except  the  actuator  at  the  second 
joint  in  the  first  subchain,  i.e.,  only  ^ then  the 

partial  twist  ^ representing  the  instantaneous  motion  of 


the  end-effector  can  be  expressed  as  follows: 

(1)  _ , (l)i(l)  _ , (l)r<fc(l)  ^ V <t(l) 


p2 


= CO  't'  $ t'  = 0), 

p2  ^p2 


[i 


j = 3 


(4.47) 


Also  the  partial  twists  representing  the  instantaneous  motion 

(2)  (2) 

of  the  end-effector  due  solely  to  the  input  twists  (o^  ’ , 

he  determined  using  (4.33) 

respectively  as  follows 5 
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i. 


i. 


(2) 

•pi 

= C0<?>; 
pi  - 

fpl 

(2) 
= 0)^ 

6 

E 

j=3 

(4.48) 

(2) 

•p2 

= 

P2  - 

fp2 

(2) 
= <"2 

6 

E 

3=3 

(4.49) 

(3) 

■pi 

pi  - 

t(3) 

- 

- 0)^ 

6 

E 

3 = 3 

(4.50) 

(3) 

■p2 

= 

P2  - 

4 2 

(3) 
= 0)2 

6 

E 

3 = 3 

■^3  6 = 

(4.51) 

Introducing  this  notation,  (4.45)  can  be  expressed  in 
the  form 

3 2 


(i) 


(4.52) 


$ = co$  = E E 
1=1  m=l 

/s 

Equation  (4.52)  expresses  that  the  twist  ^ representing  the 
instantaneous  motion  of  the  end-effector  is  the  sum  of  all 
six  partial  twists. 

For  the  reverse  solution,  where  the  twist  ^ is  speci- 
fied, this  twist  can  be  expressed  in  the  form 


6 ^6 


i = ^ + . . . + (4.53) 

where  i = 1,  2,  3.  It  is  required  to  compute  the  input  scalar 
multipliers  in  each  subchain,  i.e.,  to  compute  and 

for  i = 1,  2,  3.  This  is  accomplished  by  determining  six 


(i) 


and 


^2^,  for  i = 1,  2,  3,  where  is  orthogonal 

(i)  <t(i)  d.(i)x  J.(i) 


(i)  , 


screws 

to  the  sfciu  ui  screws  > ^2  ' * * * ' ^6  ' ^ 5-o2^ 

orthogonal  to  the  set  Taking  the 

orthogonal  product  of  the  right  and  the  left  side  of  (4.53) 
with  S ^ ^ ^ and  §.^2^/  for  i = 1,  2,  3,  and  solving  for  the  six 
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unknown  input  scalar  multipliers  and  ^2^^  > then  these 


scalars  can  be  expressed  as  follows: 
(i)  _ 


i * C' 


and 


0) 


(i)  _ 


^ (i) 

i • ^02 

^2’ 


where  i = 1,  2,  3. 


(4.54) 


(4.55) 


4 .3  A Direct  Determination  of  the 

Instantaneous  Kinematics  of  the 
End-Effector  of  Fully-Parallel 
Symmetrical  Devices 

4.3.1  Basic  Equations 
/\ 

The  twist  (=  co^)  , representing  the  instantaneous 
motion  of  the  end-effector  of  the  general  M degree  of  freedom 
f ully-parallel  symmetrical  device  (Fig.  4.3)  can  be  expressed 
as  a linear  combination  of  the  joint  twists  in  any  of  the  N 
subchains  (see  equation  (4.15)  and  section  4.2.4) 

i = oji  = + ...  + (4.56) 

where  1 £ n £ N. 

Two  solutions  of  the  twist  equation  (4.56)  will  be 
presented.  Firstly,  the  forward  solution  where  the  input 
twists  are  assumed  to  be  known,  it  is  required  to  determine 
the  twist  ^ of  the  end-effector.  Secondly,  the  reverse  solution 
where  the  twist  ^ is  assumed  to  be  specified,  it  is  required  to 


compute  the  input  twists. 
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4.3.2  Forward  Solution 

For  the  forward  solution  (see  section  4.2.2),  let 

m 

denote  the  M known  input  scalar  multipliers,  where 

M 

m=l,  2,  ...,  g,  g=— , and  i=l,  2,  ...,  N.  In  each 

N 

subchain,  there  are  (M-g)  unknown  scalar  multipliers,  / 

where  j = (g+1) , (g+2) , ...,  M,  and  it  is  necessary  to 

eliminate  these  (M-g)  unknown  scalar  multipliers.  This  is 
accomplished  by  forming  g screws  each  of  which  is  orthogonal 
to  all  screws  in  the  subchain  except  the  screw  associated 
with  one  of  the  input  actuators  in  this  subchain.  Consider 
for  example  that  g=2  and  and  are  the  two  screws 

associated  with  the  two  input  actuated  joints  in  the  first 
subchain.  It  is  possible  to  determine  two  screws  and 

^2^  which  are  orthogonal  to  the  sets  of  screws  f 

^ and  f •••»  respectively.  Taking  the 

orthogonal  product  of  both  sides  of  (4.56)  with  the  appropriate 
oxthogonal  screw  1 (orthogonal  to  all  screws  in  the  ith 

subchain  except  , for  i = 1,  2,  ...,  N,  and  m = 1,  2,  ... 

g,  gives  M (=  gN)  linear  equations.  This  set  of  M equations 
can  be  written  in  a matrix  form  as  follows: 
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Equation  (4.57)  will  be  called  the  characteristic  matrix 
equation  of  fully-parallel  devices.  If  the  diagonal  matrix 
on  the  right  side  of  (4.57)  is  nonsingular,  then  (4.57)  can 
be  rearranged  in  the  form 


*For  any  two  column  vectors,  v,  and  v, 

— Jl  — ^ 


-1  -2 
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Further,  since  the  square  matrix  on  the  right  side  of  (4.58) 
is,  in  general,  nonsingular  (if  the  device  is  not  in  a spe- 
cial configuration)  then  (4.58)  can  be  expressed  in  the  form 

/*v 

i = [r]{0)}  (4.59) 


where  {03}  is  an  [MxI]  column  vector  representing  the  known 
input  scalar  multipliers. 


{00} 


0)  to , 

g 1 


to 


(N)  jT 


g 


(4.60) 


and  [r]  is  an  [MxM]  square  matrix  which  is  a function  of 
position  only. 


[r]  = [R^  R2  R3 


(4.61) 


where  R.  is  an  [Mxl]  column  vector. 
-J 


Expanding  (4.59),  the  twist  ^ representing  the  instan- 
taneous motion  of  the  end-effector  can  be  expressed  in  the 
form 


$ = toi  = (toJ^^R,  + to^^^R„  + ...  +to^^^R  ) 
- i -i  2 -2  g -g 

+ (top  ^R  + . . . + to^^^R.,  ) 

1 -g+1  g -2g 


...  + ((oj  ^R[i+g(N-i)]  + •••  + 


(4.62) 


Further  examination  of  (4.62)  provides  an  alternative 
form  and  an  important  result  is  deduced  which  will  now  be 
discussed  in  detail. 


4.3.3  The  Concept  of  Partial  Screws 

Following  the  procedure  in  section  4.2.3,  consider  now 
that  all  actuators  are  locked  except  the  actuator  at  the 
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(1)  _ ,.(1)  _ 


first  base  joint  in  the  first  subchain,  i.e.,  = o3 

u)^^^=0and  = ...  = = 0,  for  i = 2,  3, 

e 1 a 


, N. 


The  instantaneous  motion  of  the  end-effector  is  due  solely  to 
the  input  twist  The  partial  twist  representing  this 

motion  will  be  labelled  (=  Equation  (4.62) 

-^p  i pi  -“-p  1 

reduces  to 


^p  1 p 1 ^p  1 1—1 


(4.63) 


Similarly,  the  partial  twist  (=  representing 
the  instantaneous  motion  of  the  end-effector  due  to  the  input 
twist  given  by 


^p  2 p 2 ^p  2 


= 0)  2 ' R2 


(4.64) 


Also,  the  partial  twist  representing  the  instantaneous 

motion  of  the  end-effector  due  to  the  input  twist 
is  given  by 


^p  1 p 1 ^p 1 1 — g+ 1 


(4.65) 


In  general,  the  partial  twist  representing  the  instantaneous 
motion  of  the  end-effector  due  to  the  input  twist 
for  i = 1,  2,  . . .,  N and  m=l,  2,  ...,  g,  can  be 
expressed  in  the  form 


= 03 

-pm  pm  -^pm 


‘^m  — [m+g(i-l)] 


(4.66) 
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Introducing  this  notation,  (4.62)  can  be  expressed  in 
the  form 


i = (tpj*  + ip2*  + 


- - i, 


. . i 


(2) 

•p2 

(N) 

p2 


^pg 

+ i<^>) 

^pg 


^pg 


(4.67) 


Finally,  equation  (4.67)  can  be  expressed  in  the  abbrevi- 
ated form 

N g - / . s 

= 00$  = E E ^ (4.68) 

-1  1 pm 

1=1  m=  1 ^ 

The  twist  4 representing  the  instantaneous  motion  of  the 
end-effector  is  therefore  the  sum  of  all  (M)  partial  twists. 

It  is  evident  that  the  results  derived  in  this  section 
are  in  exact  agreement  with  those  derived  in  section  4.2. 

For  instance,  equations  (4.62)  and  (4.27)  are  essentially 
identical  as  are  equations  (4.68)  and  (4.35).  Equations 
(4.18)  and  (4.35)  in  section  4.2  as  well  as  equations 
(4.57)  and  (4.68)  in  this  section  completely  describe  the 
screw  system  of  the  end-effector  and  provide  the  basis  for 
examining  the  geometrical  conditions  of  special  configura- 
tions (see  Chapter  5).  However,  the  procedure  presented  in 
this  section  is  more  direct  and  requires  less  numerical 
computations.  Also  it  is  easier  to  explain  the  singularity 
in  equation  (4.57)  than  in  equation  (4.18).  Therefore,  the 
procedure  presented  in  this  section  is  considered  to  be 
superior  to  the  procedure  in  section  4.2. 


131 


4.3.4  Reverse  Solution 

The  twist  representing  the  instantaneous  motion  of  the 
end-effector  which  is  now  specified  was  expressed  as  a 
linear  combination  of  the  joint  twists  in  any  of  the  sub- 
chains (see  equation  (4.56)).  It  is  required  now  to  com- 
pute the  g input  scalar  multipliers  in  each  subchain. 

This  is  accomplished  from  equation  (4.58)  where  any  unknown 
input  scalar  multiplier  can  be  computed  as 


CO 


(i) 


i*i, 


(i) 

om 


m 


(i) 

om 


(or  = 


ioi 


(i) 


rm 


rm 


(4.69) 


where  i=l,  2,  ...,N,m=l,  2,  ...,  g,  and  where 

is  a screw  which  is  orthogonal  to  every  screw  in  the 
ith  subchain  except  • Equation  (4.69)  is  identical  to 

equation  (4.39)  . 


4.3.5  Instantaneous  Kinematics  of  the  End- 
Effector  of  Six-Deqree  of  Freedom 
Fully-Parallel  Symmetrical  Devices 

The  instantaneous  kinematics  of  the  end-effector  of 
fully-parallel  symmetrical  devices  with  six,  three,  and 
two  connecting  subchains  are  now  investigated  using  the 
shorter  direct  procedure  of  analysis  described  in  the  pre- 
vious sections  (4 . 3 . 1-4 . 3 . 4) . 


4. 3. 5.1  Six  connecting  subchains  to 
platform,  (N=6) 

In  Fig.  4.5,  the  end-effector  is  connected  to  the  base 
by  six  subchains,  i.e.,  N = 6.  There  is  one  input  actuator 
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end-effector  platform 


Figure  4.5.  Spatial  Six-Dof  Fully-Parallel 
Symmetrical  Device  with  Six 
Connecting  Subchains  to  Platform 
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(g=l)  in  each  subchain  such  that  the  end-effector  has 
mobility  M = 6.  It  is  assumed  that  this  input  actuator  is 
located  at  the  base  joint  of  each  subchain;  i.e., 
where  i=l,  2,  6,  are  the  six  known  input  twists. 

Further,  there  are  five  (M-g  = 6-1  = 5)  unknown  scalar 
multipliers,  in  each  subchain  where  j = 2,  3,  4,  5,  6. 

The  twist  (=  , representing  the  instantaneous  motion 

of  the  end-effector  could  be  expressed  as  follows: 

i = = Z (4.70) 

j = l ^ 3 

where  i = 1,  2,...,  or  6. 

It  is  necessary  to  eliminate  the  five  unknown  scalar 
multipliers  fon  j = 2,  3,  4,  5,  6,  in  each  subchain. 

This  is  accomplished  by  determining  a screw  orthogonal 

to  in  each  subchain.  Taking  the 

orthogonal  product  of  both  sides  of  (4.70)  with  for 

1=1,  2,  ...,  6,  gives  a total  of  six  linear  equations. 

Therefore,  the  characteristic  matrix  equation  (4.57)  reduces 
to 


134 


r- 


-H  CSJ  CO  <f  lO  ^ 


' 1-H  »— I t-H  'w'  ,—i  ''*-✓  t— I 

3 3 3 3 3 3 


r 


vO  •“H 

w o 
-w- 


o 

o 

o 

o 

O 

•ii 

vO 

-s/H 

o 

o 

o 

o 

m rH 

V 

/—V 

in 

o 

o 

o 

o 

<r  ^ 
<r 

o 

o 

o 

o 

CO  1-H 

V 

/-N 

CO 

O 

o 

o 

o 

CM  ^ 

V 

CM 

o 

o 

o 

o 

-wh' 

i-H  1-H 

V 

O 

o 

o 

o 

o 

f-H 

, ^ 

II 

1— H 

CM  ^ 

y-S 

CO  »-H 

/— s 

f-H 

V 

/-"S 

lO  1-H 

V 

/-*S 

v^5  ,-H 

V 

-t/H 

L 

-e<H 

-a=H 

-t/H 

J 


135 


Since,  in  general,  the  diagonal  matrix  in  (4.71)  is  nonsingular. 


then  (4.71)  can  be  rearranged  as  follows 


< 


U) 


CO 


to 


(0 


(2) 


(3) 


(4) 


(5) 


> = 


y 


T-, 


1 


(1) 


(2),x(2)  ^ol 


i 


(2)^ 


(3)" 


^ol 


1 i(4f 

^(4),^(4)  iol 


^ol 


(5)^x(5)  ^ol 


(5f 


1 


(6)*x(6)  ^ol 


ir^*Aoi 


A 


(6) 


{^} 


(4.72) 


Further,  since  the  square  matrix  on  the  right  side  of 
(4.72)  is  also  nonsingular,  if  the  device  is  not  in  special 
configuration,  then  (4.72)  can  be  expressed  in  the  form 


i = (0  i = [R^  R2  R3  R^  R5  Rg] 


(4.73) 
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Therefore,  the  twist  ^ can  be  expressed  in  the  form 
$ = (jj  $ = 0)  J ^ ^ R,  + w f ^ ^ + . . . + (jo  J ^ ^ R^ 

i — i i — z i — o 


(4.74) 


Equation  (4.74)  could  be  deduced  from  (4.63),  for  M = N = 6, 
and  g = 1. 

Now  consider  that  all  actuators  are  locked  except  the 
first  actuator  in  the  first  subchain,  i.e.,  ^ 0 and 


,(i) 


(jOj^  ' =0  for  i = 2,  3, 


, 6.  The  instantaneous  motion 


of  the  end-effector  will  be  due  solely  to  the  input  twist 
partial  twist  i.p | ^ representing  this  motion 
can  be  expressed  as  follows 


1 p 1 1 1—1 


(4.75) 


If  all  actuators  are  locked  except  the  actuator  in  the  third 
subchain,  i.e.,  i-  0 and  = 0 for  i = 1,  2,  4,  5,  6, 


the  partial  twist  representing  the  instantaneous  motion 

of  the  end-effector  in  this  case  can  be  expressed  as  follows: 

(3)  _ ,^(3)<fc(3)  _ ,,(3). 


i 1 = ^ VrV  = A 

^P 1 p 1 ^p  1 1—3 


(4.76) 


Therefore,  equation  (4.66)  will  be  reduced,  for  m = g = 1,  to 


-ipl  pi  -tpl  1 — i 


(4.77) 


for  i=l,  2,  ...,  6. 

Introducing  this  notation,  (4.74)  can  be  expressed  in 
the  form 

^ 6/n,.»  6 /«\ 

(i)  _ V , , (i) 


^ = (JL)  ^ = Z = I coJ^-'r. 

i=l  i=l  1 


(4.78) 
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The  twist  S representing  the  instantaneous  motion  of  the  end- 
effector  is  therefore  the  sum  of  all  six  partial  twists. 

For  the  reverse  solution,  the  twist  ^ representing  the 
instantaneous  motion  of  the  end-effector  is  specified.  Using 
(4.72)  to  solve  for  the  six  unknown  scalar  multipliers 
for  i=l,  2,  ...,  6,  these  six  unknown  scalars  can  be 
expressed  in  the  form 


U) 


(i) 

1 


i 


(i) *t(i) 
1 ^ol 


(4.79) 


for  i=l,  2,  ...,  6. 

4. 3. 5. 2 Three  connecting  subchains  to 
platform,  (N=3) 

In  Fig.  4.4,  the  end-effector  is  connected  to  the  base  by 
three  connecting  subchains;  i.e.,  N = 3.  In  order  for  the  end- 
effector  to  have  mobility  M = 6 then  g = ^ = 2;  i.e.,  there 


are  two  input  actuators  in  each  subchain  which  are  assumed  to 


be  located  at  the  first  two  joints  from  the  base  of  each  sub- 


chain. Therefore,  o)  ^ ^ ^ , co  ^ ^ ^ , co 

' 1 2 ' 1 


(2) 


0) 


(2) 


CO 


(3) 


and  00, 


2 ' 1 , “2 

the  six  known  input  scalar  multipliers.  The  twist  equation 

(4.56)  reduces  to 


are 


(4.80) 


i = coi  = ...  + ^ 

where  i = 1,  2,  or  3. 

For  the  forward  solution,  the  six  input  twists  are  speci- 
fied and  it  is  necessary  to  eliminate  four  (M-g  = 4)  unknown 
scalar  multipliers,  coj^^  co^^^  and  co^^^  in  each 

-3  4 5 6 

This  is  also  accomplished  by  determining  six 


subchain . 
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screws,  and  ^2^ 

for  i = 1,  2, 

3,  such  that 

screw 

iif 

is  orthogonal  to  the 

set  of  screws 

if’-  i 

t ( i ) 

and  screw  $ 

^6  ^0  2 

is  orthogonal 

to  (|f*,  if’ 

1 4,{i) 

' £5  ' 

f 2 ) 

}.  Taking  the  orthogonal  product  of  both  sides  of  (4.80) 
with  the  orthogonal  screws,  the  characteristic  matrix 
equation  (4.57)  reduces  to 
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Equation  (4.81)  can  be  rearranged  in  the  form  which  is 
analogous  to  (4.58) 


0)i 

1 — 1 
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^ol 

0)2 
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*(i) 

^o2 
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i(2)^ 

^ol 
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*(2) 
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<h(2)*4;(2) 
^2  ^2 

(3) 
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T 

^ol 

“2 

1 

T 

i(3)*x(3) 
.^2  ^o2 

(4.82) 


Since  the  square  matrix  on  the  right  side  of  (4.82)  is 
nonsingular,  then  (4.82)  could  be  expressed  in  the  form 
(see  equation  (4.59)) 


^ (1)^ 


(i) 


i = 52  53  54  5;  5e]  <«>; 


(1) 

2 

(2) 


(4.83) 
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From  (4.83),  the  twist  representing  the  instantaneous  motion 
of  the  end-effector  can  be  expressed  in  the  form 


(1) 


(2). 


(2). 


+ (wp^R^  + 


(4.84) 


Equation  (4.84)  can  be  deduced  from  (4.62),  for  g = 2,  N = 3 
and  M = 6 . 

Now  consider  that  all  actuators  are  locked  except  the 
actuator  at  the  first  base  joint  in  the  first  subchain,  i.e.. 


CO 


(1)  _ ,,(2)  _ , (2)  _ , (3)  _ , (3)_ 


(1) 


~ ^2  ^ ~ ^1  ^ ~ ^2  0 . The  instan- 


taneous motion  of  the  end-effector  is  due  solely  to  the  input 
twist  The  partial  twist  representing  the  in- 

stantaneous motion  could  be  determined  from  (4.84)  as  follows; 


0) 


(1)4;(1)  ^ 
pi  ipi 


(4.85) 


The  partial  twist  representing  the  instantaneous  motion  of  the 
end-effector  due  solely  to  any  one  of  the  six  input  twists  can 
be  determined  either  by  substituting  the  appropriate  values 
for  the  various  scalar  multipliers  in  (4.84)  or  directly  from 
(4.66),  for  m = 1,  2,  g = 2,  and  i = 1,  2,  3;  i.e.. 


^pm  pm  ^pm 


m — [m+2 ( i- 1 ) ] 


(4.86) 


Introducing  this  notation,  (4.84)  can  be  expressed  in 
the  form 


3 

0)  ^ = Z 
i=l 


2 

Z 

m=  1 


2(i) 

^pm 


(4.87) 
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Equation  (4.87)  can  be  deduced  from  (4.68),  (for  N=3  and  g=2) , 
and  it  also  expresses  that  the  twist  j representing  the  instan- 
taneous motion  of  the  end— effector  is  the  sum  of  all  six  partial 
twists . 

/N 

For  the  reverse  solution,  the  twist  ^ representing  the 
instantaneous  motion  of  the  end-effector  is  specified.  Using 

(4.82)  to  solve  for  the  six  unknown  scalar  multipliers 
(i) 

(^2  gives 


U) 


(i)  _ 


i; 


(i) 


^ol 


(or  = 


(4.88) 


and 


(4.89) 


where  i = 1,  2,  3. 

4. 3. 5. 3 Two  connecting  subchains  to 
platform,  (N=2) 

In  Fig.  4.6,  the  end-effector  platform  is  connected  to 
the  base  by  two  subchains,  i.e.,  N = 2.  In  order  for  the  end- 
effector  to  have  mobility  M = 6 there  are  three  input  actuators, 
(g  = — = 3) , in  each  subchain  which  also  assumed  to  be  located 
at  the  first  three  joints  from  the  base,  i.e., 

and  for  i = 1,  2 are  the  six  known  input 

twists.  The  twist  (=  u ^)  , representing  the  instantaneous 
motion  of  the  end-effector  can  be  determined  from  (4.56),  for 
N = 2 and  M = 6,  as  follows: 
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Figure  4.6. 


Six-Dof  Fully-Parallel  Symmetrical  Device 
with  Two  Connecting  Subchains  to  Platform 
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I = + ...  + 


^ ,.,(2)^(2)  ,,(2)^(2) 

1 il  + ‘*'2  ^2  + • • • + <^6  t 


= CO 


(2)^(2) 
6 i-6 


(4.90) 


For  the  forward  solution,  where  the  six  input  scalar 
multipliers  are  specified,  it  is  necessary  to  eliminate  the 
other  six  unknown  scalar  multipliers,  three  (M-g  = 3)  in 

each  subchain.  This  is  accom.plished  by  determining  six  screws 
^1^'  ^2^'  i = If  2.  For  instance,  screw 

is  orthogonal  to  all  screws  in  the  ith  subchain  except  ^2^^; 
i.e.,  to  the  set  of  screws 

-^3  -^4  ^5  -^6 

for  i = 1 or  2 . Taking  the  orthogonal  product  of  each  screw 
of  these  six  orthogonal  screws  with  the  appropriate  equation 
of  (4.90),  gives  six  linear  equations.  Therefore,  the 
characteristic  matrix  equation  (4.57)  reduces  to  (for  g=3 
and  N=2) 
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Equation  (4.91)  can  be  rearranged  in  the  form 
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(4.92) 


Further,  since  the  square  matrix  on  the  right  side  of 
(4.92)  is,  in  general,  nonsingular,  then  (4.92)  can  be  ex- 
pressed in  the  same  form  (see  equation  (4.59)), 


S = u)  S = 


1-5:1  —2  —3  ^4  ^5  ^5^ 


(4.93) 
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The  twist  ^ representing  the  instantaneous  motion  of  the  end- 
effector  can  be  determined  from  (4.93)  and  also  it  can  be 
deduced  from  (4.62)  (for  M = 6,  g = 3 and  N = 2)  and 


It  should  be  noted  that  for  the  above  simple  parallel 
device,  which  consists  of  a single-closed  loop,  a single 
screw  equation  can  be  written  and  solved  without  taking 
orthogonal  products.  The  screw  equation  can  be  expressed 
in  the  form 


(4.94) 


+ ...  + (jk) 


(4.95) 


and  further  expressed  in  the  matrix  form 
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Also,  since  the  square  matrix  on  the  right  side  of 
(4.96)  is  nonsingular,  in  general,  then  (4.96)  can  be 
expressed  in  the  form 
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Expanding  (4.97),  explicit  expressions  for  the  unknown  scalar 
multipliers  can  be  written  as  follows 


= (E  + E + E 

J J 1 1 J2  2 j3  3 


+ (E  + E + E 03^^^) 

341  j52  j63 


(4.98) 


where  j = 4,  5,  6.  Substituting  (4.98)  in  the  first  twist 
equation  in  (4.90),  then  ^ can  be  expressed  in  the  form 

= 0)^  = E + Z E. 

m= 1 


+ [ E E.  , , 

m j=4  j(m+3)- 


(4.99) 


Equation  (4.99)  is  analogous  to  (4.27). 

Now  consider  that  all  actuators  are  locked  except  the 
actuator  at  the  third  joint  in  the  first  subchain,  i.e., 

^ 0 and  = 0.  The  in- 

stantaneous motion  of  the  end-effector  will  be  due  solely  to 
the  input  twist  The  partial  twist  representing  this 

motion  can  be  determined  from  (4.95)  as  follows 


(4.100) 


-p  3 P 3 3 

Introducing  this  notation,  (4.94)  can  be  expressed  in 
the  form 
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(4.101) 


Therefore,  (4.101)  indicates  that  the  twist  ^ representing  the 
instantaneous  motion  of  the  end-effector  is  the  sum  of  all  six 


partial  twists  of  the  end-effector. 
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Finally,  for  the  reverse  solution,  where  the  twist  ^ 
representing  the  instantaneous  motion  of  the  end-effector  is 
specified,  it  is  required  to  compute  the  six  input  twists. 
From  (4.93),  expressions  for  the  six  unknown  scalar  multi- 
pliers can  be  expressed  in  the  form 


(jO 
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i ( 1 ) ( 1 ) 


(or  = 
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(4.102) 
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(2) 
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^3 


) 


(4.103) 


where  j = 1,  2,  3. 


4.3.6  Instantaneous  Kinematics  of  the  End- 
Effector  of  a Planar  Fully-Parallel 
Symmetrical  Device 

The  instantaneous  kinematics  of  the  end-effector  of  the 
planar  version  of  the  spherical  three-degree  of  freedom  Florida 
Shoulder  (see  Fig.  4.7)  is  now  investigated  in  detail  using  the 
procedure  described  in  sections  4. 3. 1-4. 3. 4.  The  end-effector 
platform  is  connected  to  the  base  by  three  subchains,  i.e., 

N = 3.  In  order  for  the  end-effector  to  have  mobility  M = 3, 
there  is  one  input  actuator  in  each  subchain  (g  = |-  = 1)  . 

It  is  assumed  to  be  located  at  the  base,  i.e., 

^2^  / and  three  known  input  twists. 

/s 

The  twist  (=  u^) , representing  the  instantaneous 
motion  of  the  end-effector  can  be  expressed  as  a linear  com- 
bination of  the  joint  twists  in  any  subchain  in  the  device 
(see  equation  (4.56)), 
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end-effector  platform 


Figure  4.7.  Planar  Version  of  the  Spherical 
Florida  Shoulder 
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+ 


2 ^2 


(4.104) 


for  i = 1,  2,  3. 

For  the  forward  solution  where  the  three  input  scalar 
multipliers  are  specified,  it  is  necessary  to  eliminate  two 
(M-g  = 3-1  = 2)  unknown  scalar  multipliers  and  in 

each  subchain.  As  mentioned  previously  in  section  4.3.2,  this 
is  accomplished  by  determining  three  screws 

orthogonal  to  the  screws  {^2^^  t ^3^^  K ^^2^^  > ^3^^  ^ 

{^2^^  , respectively.  Taking  the  orthogonal  product  of 

both  sides  of  (4.104)  with  the  appropriate  orthogonal  screw, 
gives  three  (M  = 3)  linear  equations  which  can  be  expressed 
in  the  matrix  form. 


(4.105) 

When  the  device  is  not  in  a special  configuration  (see  section 
5.2),  equation  (4.105)  can  be  rearranged  in  the  form 


to 
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(4.106) 
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Equation  (4.106)  could  be  derived  directly  from  (4.58)  for 
g = 1 and  N = 3 . 

Further,  since  the  square  matrix  on  the  right  side  of 
(4.106)  is,  in  general,  nonsingular,  then  (4.106)  can  be 
expressed  in  the  form 


(4.107) 


From  (4.107),  the  twist  ^ representing  the  instantaneous 
motion  of  the  end-effector  can  be  expressed  as  follows  : 


!_  = 0)|_  = 


+ 


(4.108) 


Equation  (4.108)  could  be  derived  from  (4.62),  for  g = 1 and 
N = 3. 


Now  consider  that  all  actuators  are  locked  except  the 
one  at  the  first  base  joint  in  the  first  subchain,  i.e., 

^ instantaneous  motion  of 


the  end-effector  is  due  solely  to  the  input  twist 

The  partial  twist  representing  this  motion  will  be  labelled 


/ 1 \ 

Equation  (4.108)  reduces  to 

1 p 1 1 1—1 


(4.109) 


Similarly,  the  partial  twists  and  representing  the 

instantaneous  motion  of  the  end-effector  due  to  the  input 
twists  and  respectively  are  given  by 
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and 


i(2)  „(2)i(2)  _^(2). 

ipl  = ^pl  ""^1  -2 


= .(3)^(3)=  (3)p 

J-p  1 p 1 ^p  1 1—3 


(4.110) 


(4.111) 


Introducing  this  notation,  (4.108)  can  be  expressed  in  the 
form 


!_  = o)|_  = !_ 


(1) 

pi 
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(2) 

pi 
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(3) 

pi 


(4.112) 


Therefore,  (4.112)  indicates  that  the  twist  ^ representing 
the  instantaneous  motion  of  the  end-effector  is  the  sum  of 
the  three  partial  twists. 

For  the  reverse  solution  where  the  twist  representing 
the  instantaneous  motion  of  the  end-effector  is  specified,  it 
is  required  to  compute  the  three  input  twists.  From  (4.105) 
the  three  unknown  scalar  multipliers  can  be  expressed  in  the 
form 
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(1)  _ 
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^1 


(2) 
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(2)  _ 


(or  = 


(2), 


and 
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(3) 


(or  = 
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(4.113) 


(4.114) 


(4.115) 


The  above  expressions  for  03^^\  03^^\  andco^^^  could  be  derived 
directly  from  equation  (4.69)  for  m = 1 and  i = 1,  2,  3. 
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4 . 4 Instantaneous  Kinematics  of  the  End- 
Effector  of  Asymmetrical  Fully- 
Parallel  Devices 

The  general  analysis  peocedures  developed  in  sections 
4.2  and  4.3  cannot  be  applied  directly  to  asymmetrical 
devices.  This  is  simply  because  a unified  notation  cannot 
be  devised  for  counting  the  number  of  joints  and  the  number 
and  location  of  the  actuated  joints  in  each  subchain.  There- 
fore, each  asymmetrical  device  will  be  analyzed  separately. 

Figure  4.8  illustrates  an  asymmetrical  fully-parallel 
device  in  which  the  end-effector  platform  is  connected  to 
the  base  by  three  subchains,  (N=3) . In  order  for  the  end- 
effector  to  have  mobility  M = 6,  six  input  actuators  are 
needed  to  drive  the  platform.  They  will  be  assumed  to  be 
located  as  follows:  three  at  the  first  three  joints  from  the 

base  of  the  first  subchain,  two  at  the  first  two  joints  from 
the  base  of  the  second  subchain,  and  one  at  the  base  joint 
of  the  third  subchain,  i.e., 

and  are  the  known  input  scalar  multipliers. 

Procedures  analogous  to  both  procedures  of  sections  4.2 
and  4.3  could  be  developed  for  the  analysis  of  this  asymmet- 
rical device.  However,  a procedure  analogous  to  that  of 
section  4.3  is  presented  in  this  section. 

The  twist  ^ representing  the  instantaneous  motion  of 
the  end-effector  platform  can  be  expressed  in  the  form 
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end-effector  platform 


Figure  4.8.  Six-Degree  of  Freedom  Fully-Parallel 
Asymmetrical  Device  with  Three 
Connecting  Subchains  to  Platform 
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In  the  above  set  of  equations  (4.116)  there  are  three  unknown 

scalar  multipliers,  t first  equat- 

tion,  four  scalar  m.ultipliers , and  in 

j 4 5 6 

the  second  equation  and  five  unknown  scalars,  03^^^  , , 

2 3' 

^4^^  ' ^5^^  ' third  equation.  In  order  to 

/s 

determine  the  twist  ^ it  is  necessary  to  determine  six  or- 


thogonal screws,  ^ 


(2) 


(2) 

>2 


and 
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where  is  orthogonal  to  the  set  of  screws 


^ ' ^5  ^ fo^  i = If  2,  3;  ^2^  is  orthogonal  to  the 


(i) 


(i) 


set  of  screws  for  i = 1,  2 ; 

and  is  orthogonal  to 

Taking  the  orthogonal  products  of  ^rid  then  of 

^03^  with  the  first  equation  of  (4.116),  of  and 

with  the  second  equation,  and  of  with  the  third  equat- 

tion  in  (4.116)  gives  six  (M=6)  equations  which  are  linear 
in  the  six  known  input  twists.  This  set  of  equations  can  be 


written  in  the  matrix  form 
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The  characteristic  matrix  equation  (4.117)  can  be  rearranged 
in  the  form 
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(4.118) 


Further,  since  the  square  matrix  on  the  right  side  of  (4.118) 
is,  in  general,  nonsingular,  then  (4.118)  can  be  expressed  in 
the  form 


i 0)^  [Rj^  R^  R5  5:6^ 


(4.119) 
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Expanding  (4.119),  the  twist  ^ can  be  expressed  in  the  form 


= ((.(1) 
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(4.120) 


Now  consider  that  all  actuators  are  locked  except  the 
actuator  at  the  second  joint  in  the  first  subchain,  i.e., 

instantaneous  motion  of  the  end-effector  platform  is  due 
solely  to  the  input  twist  . The  partial  twist 

representing  this  instantaneous  motion  can  be  determined 
from  (4.120)  by  substituting  ,.,(2)  ,.,  ( 2 ) 


^ ' , oj^  ' , and 


= 0,  yielding 


|(1)  = ^(l)i(l)  = ^(Dr 

^2  p2^2  2—2 


(4.121) 


In  a similar  fashion,  the  other  partial  twists  can  be 
expressed  in  the  form 
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(4.123) 

(4.124) 

(4.125) 


and 


(4.126) 
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Introducing  this  notation,  (4.120)  can  be  expressed  in  the 
form 


I = “i  = + ip2*  + ips’’ 


. + tr>  * ij?’ 


(4,127) 


Then  the  twist  ^ representing  the  instantaneous  motion  of  the 
end-effector  is  the  sum  of  all  six  partial  twists. 

/s 

For  the  reverse  solution  where  the  twist  ^ representing 
the  instantaneous  motion  of  the  end-effector  is  specified, 
the  six  unknown  scalar  multipliers  can  be  expressed  as  follows: 
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j = 1,2 
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(4.130) 


The  above  expressions  are  obtained  by  solving  (4.117). 


CHAPTER  5 

SPECIAL  CONFIGURATIONS 

The  first  section  of  this  chapter  is  essentially  a lit- 
erature survey  of  special  configurations  of  single-  and 
multi-loop  devices  [3,9,40-44].  The  literature  on  multi- 
loop devices  is  sparse  and  the  author  has  included  in  this 
section  an  introduction  to  the  so-called  uncertainty  con- 
figurations of  multi-loop  devices. 

In  the  second  section,  special  configurations  of  fully- 
parallel  devices  are  investigated  in  detail  using  the  char- 
acteristic matrix  equation  (4.57)  derived  in  the  previous 
chapter.  These  results  are  then  summarized  in  Table  5.1. 
By  way  of  example,  special  configurations  of  the  planar 
three-dof  Florida  Shoulder  are  studied  in  detail  and 
numerical  results  are  presented. 

5 . 1 Special  Configurations  of  Single- 
and  Multi-Loop  Devices 

5.1.1  Introduction 

The  term  "Special  Configuration"  was  introduced  by  Hunt 
in  [3]  and  is  used  to  describe  various  unique  geometrical 
phenomena  which  occur  in  the  motion  of  planar,  spherical, 
and  spatial  mechanisms.  Generally,  for  single— looo  mech- 
anisms, these  special  configurations  could  be  categorized 
into  "Stationary  Configurations"  and  "Uncertainty 
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Configurations."  In  addition  to  these  two  types,  an  arrange- 
ment of  interconnected  links  may  form  an  immovable  structure. 
Examples  of  a stationary  configuration,  an  uncertainty  con- 
figuration, and  an  immovable  structure  using  the  familiar 
planar  four-bar  linkage  are  shown  in  Fig.  5.1. 

5.1.2  Stationary  Configurations 

A kinematic  chain  is  in  stationary  configuration  when  at 
least  one  joint  is  transitorily  inactive.  A joint  is  transi- 
torily inactive  when  the  scalar  multiplier,  to  , of  the  twist 
of  that  joint  is  instantaneously  zero  no  matter  the  values 
of  the  other  multipliers.* 

A stationary  configuration  is  referred  to  in  the  litera- 
ture as  an  "extreme-range  position,"  "dead  center,"  "change 
point,"  or  "limit  position."  However,  the  generality  of  the 
concept  of  stationary  configurations  is  preferred  as  it 
relates  to  transitorily  inactive  freedom (s) . 

Consider  the  four-bar  planar  mechanism  in  Fig.  5.1(a). 

The  revolute  joint  is  shown  at  its  two  extreme  angular  posi- 
tions. In  either  case,  the  axes  of  screws  , and 

representing  the  relative  motion  of  the  first,  second,  and 
the  third  joints  lie  in  the  same  plane.  In  this  configura- 
tion the  intersection  of  the  two  screw  systems  spanned  by 
^■2 ' ^3^  zero  vector  (see  the  parallel 

*For  kinematic  chains  with  M > 1,  a joint  can  be  inactive  if 
the  M independent  input  scalar  multipliers  happen  to  have 
values  that  make  the  scalar  multipliers  associated  with 
this  joint  vanish.  However,  it  is  inappropriate  to  call 
such  a joint  an  inactive  joint  [40] . 
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(c)  immovable  configuration 


Figure  5.1.  Special  Configurations  and  Immovable 
Structure  of  a Planar  Four-Bar 
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law,  equation  (2.30))  and  therefore  joint  is  considered 
to  be  transitorily  inactive  (or  equivalently,  link  is 
transitorily  inactive),,  i.e.,  C04  = 0. 

Hunt  [3]  introduced  a theorem  which  can  be  restated  as 
follows : 

When  (g-p)  screws  of  a single-closed  loop  mechanism 
containing  g (=  d+1)  single-freedom  joints  become 
linearly  dependent  instantaneously  and  none  of  the 
remaining  p linearly  independent*  screws  are  linearly 
dependent  on  these  (g-p)  screws,  then  the  (g-p)  screws 
form  a configuration  with  mobility  one,  i.e.,  they 
belong  to  a ((g-p)-l),  (=  d-p) , system.  The  remaining 
p screws  form  a configuration  which  cannot  move  instan- 
taneously. The  mechanism  is  said  to  be  in  a simple, 
double,  triple,  . . .,  stationary  configuration 
respectively  when  p=l,  2,  3,  ...,  5. 

Figure  5rl(a)  illustrates  a simple  stationary  configuration, 
(g=4,  and  p=l) . Figure  5.2  illustrates  a spatial  four  link 
RSCR  mechanism  in  a double  stationary  configuration,  (g=7 
and  p=2)  , for  which  the  five  screws  / ^2 ' • • * ' ^5  belong 
to  a four-system.  There  are  two  linearly  independent  screws 
and  ^^2  (pure  forces)  which  are  reciprocal  to  the  four- 
system.  The  remaining  two  screws,  and  , representing 
the  translatory  freedom  of  the  C-pair  and  the  rotary  freedom 
of  the  R^  pair  are  instantaneously  inactive. 

Stationary  configurations  of  a single-closed  loop  mech- 
anism [41,42]  can  be  detected  by  monitoring  all  the  [dxd] 
determinants  of  the  [dx(d+l)]  matrix  of  the  screw  coordin- 
ates (see  equation  (2.44)),  or  alternatively  by  monitoring 


*If  these  p screws  are  not  linearly  independent,  then  it  is 
an  uncertainty  configuration  which  is  discussed  in  the  next 
section . 
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Figure  5.2.  R-S-C-R  Spatial  Mechanism  in 

a Double  Stationary  Configuration 
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the  [dxd]  Gramians  of  the  g screws  (see  equation  (2.45)  with 
n=g) . A kth  joint  is  inactive  when  the  [dxd]  determinant 
which  does  not  include  the  kth  column  vector  vanishes,  (or 
when  the  [dxd]  determinant,  deduced  from  the  Gramian,  which 
does  not  include  both  the  kth  row  and  column,  vanishes) . 

Equation  (2.43),  which  was  derived  for  a single-loop 
mechanism,  can  be  easily  extended  to  multi-loop  mechanisms. 
Davies  [38]  derived  such  an  equation  for  mechanism  with  v 
independent  loops*  and  called  it  the  constraint  equation 
(see  equation  (4.10)).  The  constraint  equation  can  be 
transferred  into  the  canonical  form  (see  equation  (4.11)) 


Equation  (5.1)  is  everywhere  identical  to  (4.11)  except  that 
the  subscript  M replaces  the  subscript  F.  When  a unit  ele- 
ment in  the  identity  matrix  I is  the  only  non-zero  element 

in  that  row  of  the  constraint  matrix  C , then  the  corre- 

6 V , e 

spending  element  of  i.e.,  the  corresponding  scalar 

multiplier,  must  be  zero  and  the  corresponding  joint  is  said 
to  be  transitorily  inactive.  Equation  (5.1)  can  be  rearranged 
in  the  following  form  which  highlights  the  zero  elements  of 


0 


(5.1) 


*When  V = 1,  equation  (2.43)  and  (4.10)  are  identical. 
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In  equation  (5.2),  M is  the  degree  of  freedom,  e is  the 

number  of  joints,  r is  the  rank  of  the  constraint  matrix 

C (see  equation  (4.10),  and  q„  ^ is  an  [Mxl]  column 

vector  which  contains  the  M known  input  scalar  multipliers 

(primary  coordinates) . The  secondary  coordinates  w have 

r , 1 

been  further  subdivided  into  the  p coordinates  comprising 
^ that  have  zero  values,  and  (r-p)  comprising  co  ^ 
that  can  be  expressed  in  terms  of  the  primary  coordinates 
qj^  Further,  the  following  result  can  be  deduced  from 
(5.2)  : 

When  the  scalar  multiplier  of  the  twist  of  a joint  is 
instantaneously  zero  no  matter  the  values  of  the  other 
multipliers,  the  mechanism  is  said  to  be  in  a station- 
ary configuration.  When  one  joint  is  transitorily  inac- 
tive (p=l) , the  mechanism  is  in  a simple  stationary 
configuration.  When  two,  three,  ...,  etc.,  joints  are 
transitorily  inactive  (p=2,  3,  ...),  the  mechanism  is 
in  a double,  triple,  ...,  etc.  stationary  configura- 
tion. 

It  is  important  to  note  that  a stationary  configuration  does 
not  affect  the  rank  r of  the  constraint  matrix.  For  instance, 
all  seven  screws  in  Fig.  5.2  belong  to  a six-system  when  the 
mechanism  is  not  in  a stationary  configuration  and  also  when 
the  mechanism  is  in  a simple,  double,  . . . , etc.  stationary 
configuration. 
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5.1.3  Uncertainty  Configurations 

Stationary  configurations  for  mechanisms  for  which  one 
or  more  joints  have  become  transitorily  inactive  have  been 
discussed.  It  is  now  appropriate  to  discuss  the  special 
configurations  of  structures  for  which  one  or  more  joints 
have  become  transitorily  active. 

As  an  example,  consider  the  pin- jointed  structure  with 
zero  overall  mobility  illustrated  in  Fig.  5.3(a).  Here, 
neither  of  the  two  independent  loops  which  when  considered 
separately  are  planar  four-bar  mechanisms  can  have  motion 
since  the  ternary  2 cannot  rotate  simiultaneously  about  two 
distinct  instant  centers  and  . However,  Figs.  5.3(b) 
and  (c)  which  are  topologically  the  same  as  Fig.  5.3(a) 
illustrate  configurations  which  are  respectively  transi- 
torily mobile  and  permanently  mobile.  For  the  configura- 
tion illustrated  in  Fig.  5.3(b),  and  coincide 
instantaneously  at  point  I and  therefore  the  ternary  2 
can  rotate  throughout  an  inf initesim.al  angle  about  I. 
However  any  finite  relative  motion  could,  of  course, 
destroy  that  special  geometrical  feature  of  coincidence. 
Buckens  [43]  called  the  configuration  in  Fig.  5.3(b), 
Singular,"  Paul  [44]  said  the  configuration  had  an  in- 
stantaneously critical  form.,  while  Hunt  [3]  simply  said 
it  was  transitorily  miobile.  Whereas,  for  the  configura- 
tion illustrated  in  Fig.  5.3(c),  and  coincide  per- 
manently at  a point  at  infinity.  This  configuration  of 
the  double  parallelogram.  Fig.  5.3(c),  which  has  complete 
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Figure  5.3.  Some  Planar  Arrangements  with  the  Sam.e  Topology 
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cycle  mobility  was  described  by  Paul  [44]  to  be  in  a perma- 
nently critical  form. 

The  above  discussion  is  illustration  that  a structure 
can  gain  one  or  more  freedoms  and  become  mobile.  Analogous- 
ly, a mechanism  can  transitorily  acquire  one  or  more  extra 
degrees  of  freedom  during  its  cycle.  For  example,  consider 
the  planar  four-bar  mechanism  illustrated  in  Fig.  5.1(b). 

The  axes  of  all  four  screws  representing  the  joint  motions 
lie  in  the  same  plane.  It  has  a transitory  mobility  M = 2 
and  therefore  it  can  open  up  in  two  distinct  ways  (see  Fig. 
2.7,  [3]  ).  It  is  also  important  to  note  that  when  any 
joint  in  Fig.  5.1(b)  is  locked  there  still  a transitorily 
mobile  flattened  triangle  which  is  also  a jointed  structure 
with  transitory  mobility  M = 1. 

Uncertainty  configurations  are  often  referred  to  in  the 
literature  as  "folded  configurations,"  "flattened  configura- 
tions," or  "locking  or  cross-over  positions."  However,  the 
generality  of  the  concept  of  uncertainty  configuration  is 
preferred  as  it  relates  to  the  acquisition  of  one  (or  more) 
extra  mobility  (or  reduction  in  constraints) . 

Hunt  introduced  a theorem  in  [3],  which  can  be  restated 


as  follows: 
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When  all  the  g (=d+l)  screws  representing  the  instan- 
taneous motion  of  the  joints  of  a single-closed  loop 
mechanism  with  ordinary  mobility  M = 1 are  linearly 
dependent  and  belong  to  a g-(j+l)  screw  system,  then 
these  g screws  are  reciprocal  to  j common  reciprocal 
screw (s) / 1 £ j £ (d-1) , and  the  loop  is  said  to  be 
at  a j-fold  uncertainty  configuration  and  its  mobility 
is  transitorily  increased  by  j,  i.e.,  increased  from 
M=ltoM=j+l. 

As  an  example,  consider  the  RSCR  spatial  mechanism  illus- 
trated in  Fig.  5.4.  In  this  configuration,  all  the  seven 
screws  representing  the  joint  motions  have  become  linearly 
dependent  and  they  instantaneously  belong  to  a five-system, 
i.e.,  the  rank  of  the  matrix  of  all  seven  screws  is  reduced 
from  six  to  five.  There  is  a single  screw  ^ (a  pure 
force)  reciprocal  to  all  these  seven  screws.  Depending 
upon  the  inertial  loading,  when  the  input  link  a^^  is 
being  driven,  there  are  two  distinct  modes  for  the  motion 
of  the  remaining  links.  The  mechanism  has  instantaneously 
mobility  M = 2 and  is  said  to  be  in  a single-fold  uncer- 
tainty configuration. 

Uncertainty  configurations  [41,42]  of  single-closed 
loop  mechanisms  can  also  be  detected  by  monitoring  the 
[dx(d+l)j  matrix  of  screw  coordinates  (see  equation  (2.44)) 
or  their  Gramian  (see  equation  (2.45)).  A j-fold  uncer- 
tainty configuration  occurs  when  the  rank  of  this  matrix 
is  (d-j ) . 

As  discussed  in  the  previous  section,  equation  (2.43) 
can  be  extended  to  mechanisms  with  v independent  loops  (see 
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Figure  5.4. 


R~S-C-R  Spatial  Mechanism  in 
a Single-Fold  Uncertainty 
Configuration 
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equation  (5.1)).  Equation  (5.1)*  can  be  used  to  determine 
uncertainty  configurations  for  both  single-  and  multi- 
loop mechanisms,  and 

A j-fold  uncertainty  configuration  occurs  when  the 
rank  of  the  constraint  matrix  Cev,e  is  instantaneously 
reduced  by  j (i.e.,  from  r to  (r-j)).  This  means  that 
there  exist  j independent  screws  reciprocal  to  the 
screw  system  of  all  screws  of  the  mechanism. 

A mechanism  can  ordinarily  be  expected  to  have  several 

stationary  configurations  in  its  cycle  and  it  will  pass 

through  provided  that  the  input  actuator's  freedom  never 

become  inactive.  However,  a mechanism  will  not  ordinarily 

encounter  an  uncertainty  configuration  during  its  cycle 

unless  it  has  special  dimensions.  Mechanisms  which  have 

uncertainty  configurations  are  obviously  best  avoided. 

However,  it  is  sometimes  difficult  to  distinguish 
between  stationary  and  uncertainty  configurations  of 
mechanisms,  especially  parallel  mechanisms. 


5.2  Special  Configurations  of  Fully- 
Parallel  Devices 

5.2.1  Introduction 


Fully  Parallel  devices  may  also  encounter  some  special 
configurations  other  than  those  discussed  in  the  previous 


In  the  canonical  form,  equation  (5.1),  there  are  (6v-r) 
zero  rows  which  represent  constraints  that  are  additional 
to  the  minimum  necessary  for  the  mechanism  to  perform  its 
intended  function.  These  additional  constraints  are 
called  in  1.40]  redundant  constraints,  and  the  number 

called  the  degree  of  redundancy.  A mechanism 
with  redundancy  is  usually  called  an  overconstrained  or 
overdosed  mechanism. 
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sections.  Such  special  configurations  will  not  be  detected 
in  a straight-forward  approach  using  the  only  existing  pro- 
cedure for  multi-loop  devices  which  was  introduced  by  Davies 
[40]  and  has  been  reviewed  in  the  previous  sections  (5.1.2, 
5.1.3)  . 


Equation  (4.57),  together  with  equation  (4.58),  most 
elegantly  describes  the  instantaneous  kinematics  of  fully- 
parallel  devices  and  gives  the  geometrical  conditions  for 


special  configurations.  The  characteristic  matrix  equation 
(4.57)  can  be  rewritten  as  follows: 


(5.3) 

Further,  (5.3)  can  be  expressed  in  the  abbreviated  form 


[C]{w}  = [D]{|}  (5.4) 

where  [C]  is  a [MxM]  diagonal  matrix  and  [D]  is  also  a [MxM] 
matrix,  (M  = gN,  see  Chapter  4). 


A mechanism  is  in  special  configurations  at  the  instant 
that  at  least  one  of  the  two  matrices  [C]  and  [D]  in  equation 
(5.4)  becomes  singular.  When  matrix  [C]  becomes  singular 
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there  are  additional  constraints  acting  upon  the  end-effector 
platform,  and  when  matrix  [ D]  becomes  singular  there  are  re- 
strictions on  the  input  velocities.  Six  different  cases 
may  arise.  These  cases  are  described  and  investigated  in 
detail  in  the  following  sections. 

5.2.2  Case  I 

Matrix  [ C]  becomes  singular  if  and  only  if  at  least 
one  of  its  diagonal  elements  becomes  zero,  i.e., 

= 0 (5.5) 

for  i = 1,  2,  ...,  or  N,  and  j = 1,  2,  ...,  or  g.  Equation 

(5.5)  implies  that  the  screw  is  orthogonal  to  (or, 

equivalently,  the  corresponding  screw  is  reciprocal 

to)  all  M screws  in  the  ith  subchain  since  is  (by  def- 

iriition)  orthogonal  to  all  screws  in  the  subchain  except 

Therefore,  these  M screws  are  not  linearly  indepen- 
■dent  and  the  screw  system  spanned  by  these  M screws 
degenerates , 

dim  (W^)  < M (5.6) 

It  can  be  deduced  from  (5.4)  that  when  n diagonal  elements 
of  [c]  vanish  simultaneously,  then  the  corresponding  n or- 
thogonal screws  in  [D]  represent  the  unattainable 

motion  of  the  end-effector  platform.  This  is  because 

i * = » (5.7) 

/s 

where  ^ is  the  twist  representing  the  instantaneous  motion 
of  the  end-effector.  Therefore,  the  order  of  the  screw 
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system  representing  the  instantaneous  motion  of  the  platform 
reduces  by  n and  there  are  n extra  constraints  acting  upon 
the  platform,  provided  that  the  set  of  these  n orthogonal 
screws  are  themselves  not  linearly  dependent. 

It  can  thus  be  deduced  that  when  [d]  is  nonsingular 
and  that  when  [C]  is  singular,  its  rank  being  reduced  by  n, 
the  platform  then  loses  n freedoms. 

It  is  important  to  notice  that  the  value  of  each  scalar 
multiplier  associated  with  a screw  that  satisfies 

equation  (5.5)  is  arbitrary.  In  other  words,  the  values  of 
the  scalar  multipliers  not  affect  the  resultant 

instantaneous  motion  of  the  end-effector  platform. 

5.2.3  Case  II 

When  all  the  diagonal  elements  of  matrix  [C]  become 
zero  simultaneously,  i.e., 

i'"’-  * = 0 (5.8) 

and  the  screw  system  spanned  by  the  M screws  in  each  sub- 
chain degenerates*, 

dim  ) < M (5.9) 

for  i=l,  2,  ...,  N.  This  means  that  all  the  M orthogonal 
screws  in  [d]  represent  the  unattainable  motion  of  the  end- 
effector  platform  since 


The  subchains  considered  here  are  those  subchains  that  con- 
tain at  least  one  actuated  joint  (for  asymmetrical  devices) . 
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When  matrix  [ D]  is  nonsingular,  all  these  M orthogonal  screws 
linearly  independent  and  they  form  an  orthogonal  screw 
system  which  represents  the  unattainable  motion  of  the  end- 
effector  platform.  Since  this  orthogonal  screw  system 
spans  the  whole  space,  the  platform  will  be  immovable  and 
the  device  becomes  an  immovable  structure  regardless  of  the 
values  of  the  inputs. 

5.2.4  Case  III 

Matrix  [ D]  becomes  singular  when  its  M rows,  which  are 
the  M orthogonal  screws  become  linearly  dependent.  The 

rank  of  [D]  reduces  instantaneously.  When  matrix  [C]  is 
nonsigular , equation  (5.4)  can  be  expressed  in  the  form  (see 
also  equation  (4.58)). 


(5.11) 
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Equation  (5.11)  can  also  be  expressed  in  the  abbreviated  form 

{w}  = [A]  {|}  (5.12) 

where  [A]  = [C]"^[D]. 

The  inverse  [C]“^  is  nonsingular  and  thus  the  rank  of 
[A]  is  equal  to  the  rank,  r,  of  [D]  which  is  less  than  M. 
Therefore,  the  column  space  of  [A],  cs[A],  is  of  order  r. 

In  order  for  equation  (5.12)  to  have  at  least  a solution, 
the  column  vector  {co}  has  to  be  an  element  of  the  column 
space  of  [A]  ,i.e.,  {o)}  e cs[A].  The  input  scalar  multi- 
pliers cannot  be  chosen  independently,  therefore,  since 
dim(cs[A]  ) < M.  In  this  case  for  a specified  set  of  inputs 
there  exists  more  than  one  solution  Therefore,  it  can 
be  concluded  that  the  M chosen  inputs  are  dependent  and  are 
not  capable  of  controlling*  the  end— effector  platform  for 
any  specified  motion.  In  order  to  control  the  platform 
some  other  joint  or  joints  must  be  actuated. 

The  twist  ^ representing  the  instantaneous  motion  of 
the  end-effector  platform  is  in  the  form 


i = (L)  + + 


a $ 
2^: 


+ a $ ) 


(5.13) 


/\ 

where  is  a solution  to  equation  (5.12),  a^,  a^ , ...  , 
a^  are  v (=  M-r)  independent  scalars,  and  •••  ' 
form  a basis  for  the  solution  set  of  the  corresponding 


*A  wrench  applied  to  the  end-effector  platform  cannot  be 
controlled  (resisted)  by  these  M inputs. 
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homogeneous  system*  [A]|^  = Therefore,  by  locking  all  these 

M dependent  chosen  input  actuated  joints,  = 0,  the  system 

will  not  be  a structure  as  it  should  be.  Such  linkages  were 
described  by  Buckens  [43]  as  having  a singular  configura- 
tion. The  remaining  linkage  will  be  in  a simple,  double,., 
etc.  singular  configuration  if  v = 1,  2,  ...,  etc. 

It  can  now  be  concluded  that  when  matrix  [C]  is  non- 
singular and  that  when  [p]  is  singular  then  the  input  scalar 
multipliers  cannot  be  chosen  independently. 

5.2.5  Case  IV 

For  Case  I matrix  [c]  was  singular  when  n diagonal 
elements  (1  _<  n < M)  were  zero  simultaneously  with  the  cor- 
responding n orthogonal  screws  in  [d]  representing  the 

unattainable  motion  of  the  end-effector  platform,  and  matrix 
[D]  was  nonsingular. 

Consider  now  that  [D]  also  become  singular  because  any 

one  screw  ^ of  the  remaining  (M-n)  orthogonal  screws  in 

[d]  is  dependent  on  the  n orthogonal  screws.  The  scalar  mul- 

tiplier  ^ associated  with  this  must  vanish  and  the 

J -^o  J 

joint  is  momentarily  inactive.  More  generally,  a subset  of 
the  (M-n)  orthogonal  screws  can  become  dependent  on  those  n 
screws.  Each  of  the  scalar  multipliers  associated  with  the 
(M-n)  screws  in  the  subset  must  vanish  momentarily.  All  the 

*{^l,  1^2^  •••/  form  a basis  for  the  kernel  of  [A],  i.e., 

a basis  of  the  null  space  of  [a] . The  dimension  of  the  null 
space  of  [A]  is  called  the  nullity  of  [A]  and  it  is  equal 
to  V (=  M-r) . 
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(M-n)  input  joints  associated  with  these  screws  thus  are 
momentarily  inactive.  This  type  of  configuration  is  anal- 
ogous to  the  stationary  configuration  discussed  in  section 
(5.1.2) . 

It  is  interesting  to  note  that  when  the  inputs  are 
locked,  the  system  will  not  be  a structure.  It  will  have 

/s 

instantaneous  mobility.  The  twist  ^ representing  the 
instantaneous  motion  of  the  end-effector  platform  in  the 
system  is  determined  by  the  null  space  of  [d] . 

5.2.6  Case  V 

Consider  again  that  matrix  [c]  is  singular  because  n 

diagonal  elements  (1  ^ n < M)  are  zero  simultaneously  and 

therefore  the  corresponding  n orthogonal  screws  in  [d] 

j 

represent  the  unattainable  motion  of  the  end-effector  plat- 
form. Consider  also  that  [D]  is  singular  because  the  n or- 
thogonal screws  have  themselves  become  linearly  dependent. 
The  order  of  the  screw  system  representing  the  unattainable 
motion  is  less  than  n and  as  in  Case  I each  of  the  n scalar 
multipliers  is  arbitrary. 

However,  [D]  can  also  become  singular  when  the  remain- 
ing (M-n)  orthogonal  screws  become  linearly  dependent.  Here 
the  scalar  multipliers  associated  with  these  (M-n)  screws 
are  themselves  dependent  whilst,  as  above,  the  n scalar 
multipliers  are  arbitrary. 

In  conclusion,  by  locking  the  inputs,  the  system  will  not 
be  a structure  but  will  have  instant  mobility.  The  twist  ^ 
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representing  the  motion  of  the  end-effector  platform  can  be 
determined  by  the  null  space  of  matrix  [d] . 

5.2.7  Case  VI 

When  all  diagonal  elements  of  matrix  [c]  become  zero 

simultaneously,  then  all  M orthogonal  screws  in  [d] 

j 

represent  the  unattainable  motion  of  the  end-effector  plat- 
form. All  the  M input  scalar  multipliers  are  arbitrary  and 
their  values  do  not  affect  the  instantaneous  motion  of  the 
end-effector  platform. 

VJhen  matrix  [D]  becomes  singular,  then  all  M orthog- 
onal screws  become  linearly  dependent  and  they  form  an  or- 
thogonal screw  system  of  order  (M-n)  which  represents  the 
unattainable  motion  of  the  end-effector  platform.  Therefore, 
the  end-effector  platform  has  n remaining  freedom (s)  and 
these  n freedom (s)  cannot  be  controlled  by  the  M indepen- 
dently chosen  inputs. 

This  type  of  configuration  is  analogous  to  the  uncer- 
tainty  configuration,  discussed  earlier  in  section  (5.1.3). 

A device  is  in  a simple,  double,  ...  uncertainty  configura- 
tion when  n = 1,  2,  ...  . 

The  above  six  types  of  special  configurations  are  list- 
ed in  Table  5.1.  It  can  be  concluded  that  unlike  single- 
loop devices  with  mobility  one,  special  configurations  of 
fully-parallel  devices  with  mobility  greater  than  one  cannot 
be  defined  simply  as  stationary  and  uncertainty  configura- 
tions. Whilst,  Cases  IV  and  VI  can  be  defined  respectively 


Types  of  Special  Configurations 
of  Fully-Parallel  Devices* 
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For  the  difference  between  Case  IV  and  Case  V,  see  sections  5.2.5  and 


184 


as  stationary  and  uncertainty  configurations.  Cases  I,  II, 
III,  and  V cannot.  Admittedly,  Case  II  which  is  an  immovable 
structure  perhaps  should  not  be  included. 


5.2.8  Special  Configurations  of  the  Planar 
Version  of  the  Florida  Shoulder* 

Case  I 

Two  distinct  types  of  Case  I special  configurations 
can  occur: 

(a)  Figure  5.5  illustrates  the  device  with  the  first 
subchain  in  a fully  extended  configuration.  The  axes  of  the 
three  revolute  joints  lie  in  the  same  plane  and  the  screws 
and  are  therefore  linearly  dependent  and 

form  a two-system,  i.e., 

dim  (W^)  = 2 

Therefore,  a screw  which  is  orthogonal  to  ^3^^) 

is  also  orthogonal  to  and, 

= 0 

The  first  diagonal  element  of  matrix  [C]  vanishes  instan- 
taneously and  [C]  become  singular.  Equation  (5.4)  reduces 
to 


*Special  configurations  of  the  planar  version  of  the  Florida 
Shoulder  were  first  considered  by  Cox  [4]  in  which  he  gave 
an  expository  account. 
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Figure  5.5. 


Example  of  Case  I- (a) 
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It  is  clear  that  the  three  orthogonal  screws 

are  linearly  independent  and  that  represents  the 


/ 1 \ 

unattainable  motion  of  the  end-effector  platform,  = 0» 

A. 

The  twist  ^ representing  the  instantaneous  motion  of  the  end- 
effector  must  lie  along  that  plane  formed  by  the  axes  of  ^ \ 

and  ^^^^and  also  formed  by  the  two  partial  twists* 

*^(2)  ^(3)  ^ 

and  . Therefore  the  twist  ^ can  be  represented  as 

the  sum  of  these  two  partial  twists,  and 


t = - i'? 


(3) 

■P^ 


= 4.0512  0) 


+ 1.833  0) 


(3) 

1 


It  is  apparent  that  the  end-effector  platform  can  move  only  in 
a direction  normal  to  that  plane  and  therefore  has  only  two 
freedoms  instantaneously.  The  input  scalar  multiplier 
can  assume  any  value  without  effecting  the  instantaneous 
motion  of  the  end-effector  platform. 

It  is  interesting  to  note  that  when  the  two  input  links 
a^2  locked  simultaneously,  the  system  becomes  a 


*The  point  formed  by  the  intersection  of  the  axis  of  the  par- 
tial twist  (i=l,2,3),  and  the  plane  of  the  device  is 

identical  with  the  planar  instant  center,  [4]. 
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structure  and  all  joints  become  inactive,  regardless  of  the 
value  of  ^ ^ • 

Clearly  the  analysis  is  the  same  when  any  other  subchain 

is  in  a fully  extended  configuration  or  when  it  is  in  a folded 

configuration  (see  Fig.  5.6). 

(b)  Figure  5.7  illustrates  the  device  with  the  first  and 

second  subchains  in  fully  extended  configurations.  The  axes  of 

screws  plane  whilst  the  axes  of 

(2)  (2)  (2) 

screws  \ $3  ^ another  plane.  Equation 

(5.4)  reduces  to 
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The  twist  ^ representing  the  instantaneous  motion  of  the  end- 
effector  platform  can  be  expressed  as  follows 

i = = (1-  833 

which  passes  through  point  (3,3). 

The  end-effector  platform  is  capable  instantaneously 
of  rotating  about  the  partial  screw  = | sj  which  is  the 

line  of  intersection  of  the  two  planes,  and  therefore  the 
end-effector  platform  loses  two  freedoms.  It  is  important 
to  note  that  the  two  input  scalar  multipliers  and  00^^^ 

can  assume  any  values  without  affecting  the  instantaneous 
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F'igure  5.6.  Example  of  Case  I- (a)  with 
Folded  Subchain 
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(3) 


Figure  5.7. 


Example  of  Case  I-(b) 
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(3) 

motion  of  the  platform.  When  the  input  link  locked 

( 3 ) 

(i.e.,  cOj'  becomes  zero),  the  system  becomes  a structure. 
Case  II 

In  this  configuration  all  three  subchains  are  fully 
extended  and  are  not  concurrent  (Fig.  5.8).  All  three 
diagonal  elements  of  matrix  [c]  vanish  simultaneously  and 
therefore  all  three  input  scalar  multipliers  can  assume  any 


value . 

Equation 

(5. 

4)  reduces  to 

0 

0 

m 

0 

0 

1 

1 

0 

0 

0 

< 
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-7.25 
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CM 

1 

Since  the  three  fully  extended  subchains  are  not  con- 
current, the  three  orthogonal  screws 

linearly  independent  and  form  an  orthogonal  three- 
system  that  represents  the  unattainable  motion  of  the  end- 
effector  platform.  Therefore,  the  end-effector  platform  will 
become  immovable  and  the  device  becomes  a structure. 

Case  III 

(a)  In  the  configuration  shown  in  Fig.  5.9,  the  screws 
representing  the  relative  motions  of  the  joints  in  each  sub- 
chain are  linearly  independent,  i.e., 

dim(Wi)  = M = 3 

for  all  subchains  (i  = 1,  2,  and  3).  Therefore  matrix  [c] 
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Figure  5.8.  Example  of  Case  II 
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Figure  5.9.  Example  of  Case  III- (a) 
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in  (5.4)  is  nonsingular  and  equation  (5.11)  becomes 


"1 

r 1 

0.5 

(0.5 

1 . 5 

1) 

(a)  . 

1 

2 

(6 

-2 

0) 

1 

, -2 

(-11 

2 

-1) 

The  three  orthogonal  screws  -ol  ^ -oi^  linearly 

dependent  and  form  a two-system*.  Therefore,  the  three  chosen 
input  scalar  multipliers  are  dependent  and  related  as  follows 


0) 


(3) 

1 


0.25 


CO 


(1) 


+ 1.75 


CO 


(2) 

1 


The  three  chosen  inputs  are  therefore  not  capable  of  control- 
ling the  end-effector  platform.  The  only  way  for  this  device 
to  exit  this  special  configuration  is  by  actuating  some  joint 

other  than  the  base  joints,  such  that  and  say 

( 3 ) 

co^  are  not  dependent. 

/\ 

The  twist  ^ representing  the  instantaneous  motion  of  the 

end-effector  platform  can  be 

( (1) 

0.1  coj^''  + 0.3 

i \ 0.3  coj^^  - 0.1 

( 0 
where  a^^  is  a scalar. 

* The  three  corresponding  reciprocal  screws  \ and 

^rl  represented  as  three  pure  forces  each^acting 

along  the  centerline  of  link  a^|)  in  a subchain  (i) , (see 

Fig.  5.9).  These  three  forces  intersect  in  a point  (5,3) 
and  therefore  the  three  reciprocal  screws  also  form  a 
two-system. 


expressed  as  follows 


' -0.2  ) 

!>+  aj  < 

-0.6/ 

1 

, 1 

194 


It  is  apparent  from  this  expression  that  when  the  base 
joints  of  the  first  and  second  subchains  are  locked 

= 0)  the  system  will  not  be  a structure.  It 
is  in  a simple  singular  configuration  (v=l) . The  twist 
representing  the  instantaneous  motion  of  the  end-effector 
platform  can  now  be  expressed  as  follows 


^ = -0.2  (a^) 


and  the  end-effector  platform  is  capable  of  twisting  about  an 
ISA  normal  to  the  plane  of  the  device  and  passing  through 
point  (5,3),  see  Fig.  5.10. 


(b)  In  Fig.  5.11,  none  of  the  three  subchains  is  stretched 
and  therefore  matrix  [C]  in  (5.4)  is  nonsingular.  Equation 
(5.11)  reduces  to 


( (1) ' 

“ 

^ I 

^ (5.5  -1.5  0.5) 

' (2) 

r ( 

f 

_i  5(0.5  -1  -1) 

/ (3) 

_3^(-0.5  1 1) 

The  two  orthogonal  screws  and  are  linearly  depen- 

/ON  (2.') 

dent,  (^j^  = ) f ^nd  therefore  all  three  orthogonal 

screws  linearly  dependent  and  form 

a two-system.  Further,  the  two  input  scalar  multipliers 
0)^^^  and  are  also  dependent  (co^^  = -3  top^)  and  there- 

fore all  three  chosen  input  scalar  multipliers  are  dependent. 
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Figure  5.10.  Exair.ple  of  Case  III- (a) 
in  Simple  Singularity 
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Figure  5.11.  Example  of  Case  Ill-(b) 
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The  three  chosen  inputs  are  therefore  not  capable  of  con- 
trolling the  end-effector  platform. 

The  twist  ^ representing  the  instantaneous  motion  of 
the  end-effector  platform  can  be  expressed  as  follows 


f -0.6316 

- 0.1579 

" -0.421  ] 

V -0.3158 

- 0.5789 

^ < 

-1.2105  ) 

0 

> 

1 

where  a^^  is  a scalar. 

It  is  apparent  from  this  expression  that  when  the  base 

joints  of  the  first  and  third  subchains  are  locked  = 

( 3 ) 

=0)  the  system  will  not  be  a structure.  It  is  in  a 
simple  singular  configuration  (v=l) . The  twist  representing 
the  instantaneous  motion  of  the  end-effector  platform  can  now 
be  expressed  as  follows 

( 1 

/N  1 

^ = -0.421  (a^)  < 2.875 

[-2.375 


and  the  end-effector  platform  is  capable  of  twisting  about 
ISA  normal  to  the  plane  of  the  device  and  passes  through 
point  (2.375,  2.875),  see  Fig.  5.11. 

(c)  In  the  special  configuration  illustatrated  in  Fig. 
5.12,  equation  (5.11)  reduces  to 


rrm 
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(1) 

1 

1 

-8 . 25 

(2) 

1 

1 

/ - 

-8 . 25 

(3) 

1 

1 

8 . 25 

(-8.25 
(-8.25 
(-8 . 25 


5.5 
5 . 5 
5.5 


0) 


0) 


{^1 


0) 


All  three  orthogonal  screws  linearly 

dependent,  form  a one-systemt 

Further,  the  three  chosen  input  scalar  multipliers  are  also 


dependent,  (o),  = to 


(1)  (2)  (3) 

' = /i\  ' = — (i)  ' ' 


).  Therefore,  the  chosen  three 


1 1 1 

inputs  are  not  capable  of  controlling  the  motion  of  the  end- 


effector  platform. 


The  twist  ^ representing  the  instantaneous  motion  of  the 
end-effector  platform  can  be  expressed  as  follows 


where  a^^  and  a^  are  two  independent  scalars.  It  is  apparent 
from  this  expression  that  when  the  base  joint  of  the  first 
subchain  is  locked  the  system  will  not  be  a structure.  It 
is  in  a double  singular  configuration  (v=2) . The  twist  rep- 
resenting the  instantaneous  motion  of  the  end-effector  plat- 
form can  now  be  expressed  in  the  form 


*A  single  pure  force  in  the  plane  and  passing  through  all 
joints  of  the  device  except  the  three  base  joints  represents 
a one-system  reciprocal  to  the  joints  in  the  folded 
configuration. 
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The  instantaneous  motion  is  thus  a combination  of  a pure  rota- 
tion about  an  axis  through  the  point  (0,  1.5)  and  a pure 
translation  (0  ; 0,1)  parallel  to  the  X-axis.  This  pure 
translation  is  equivalent  to  a rotation  about  an  axis  which 
is  in  the  plane  at  infinity  and  which  is  perpendicular  to  the 
Y axis. 


Case  IV 

Since  the  second  subchain  in  the  configuration  illustrated 
in  Fig.  5.13  is  fully  extended  then  the  second  diagonal  element 
of  [c],  in  equation  (5.4)  is  equal  to  zero,  i.e.,  n = 1,  and 


if’  *t 


(2) 
o 1 


0 


(2) 

Therefore  the  orthogonal  screw  in  this  subchain  is  also 

orthogonal  to  the  twist  ^ representing  the  instantaneous 
motion  of  the  end-effector  platform,  i.e.,  (see  section  5.2.2, 
Case  I) 

I * iif  = 0 


Equation  (5.4)  reduces  to 
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Figure  5.13. 


Example  of  Case  IV 
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-3 

0 

O 

j 

5.5  -1.5  0.5 

0 

0 

0 

0.5  -1  -1 

0 

0 

LO  ' 

o 

1 

-0.5  1 1 

The  orthogonal  screw  is  linearly  dependent  on 

Since  is  orthogonal  to  ^ then  is 

also  orthogonal  to  ^ and  therefore  and  form 

a one-system  which  represents  the  unattainable  motion  of  the 
end-effector  platform.  Therefore,  from  the  above  matrix 


equation,  o) 


(2)  C3') 

^ can  assume  any  value  while  o)^  ' has  to  equal 


( 3 

zero,  (-0.5  =0).  It  is  clear  from  Fig.  5.13  that  screws 

^2^^  ii®  same  plane  and 

/ O \ 

form  a two-system  while  ^ is  not  contained  in  that 
two-system.  Therefore,  the  base  joint  of  the  third  subchain 
is  inactive  momentarily  and  the  device  is  said  to  be  in  a 
stationary  configuration. 

It  is  apparent  that  when  the  three  base  joints  are  locked, 
or  equivalently  when  just  the  base  joint  of  the  first  subchain 


is  locked  (a)^  ^ = 0)  the  system  will  not  be  a structure.  It 


is  in  a simple  singular  configuration.  The  twist  representing 
the  instantaneous  motion  of  the  end-effector  platform  can  now 
be  expressed  in  the  form 


^ = -0.421  (a^)<  2.875  ^ 

(-2.375^ 
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and  therefore  it  is  capable  of  twisting  about  an  axis  which 
is  normal  to  the  plane  of  the  device  and  passes  through 
point  (2.375  , 2.875).  This  result  is  identical  to  that  of 
Case  III,  example  (b) . 


Case  V 

In  the  configuration  illustrated  in  Fig.  5.14,  only  the 
first  subchain  is  fully  extended,  i.e.,  n = 1,  and 


^(1)  * = 0 


Therefore,  represents  the  unattainable  motion  of  the  end- 

effector  platform  and  can  assume  any  value  without 

affecting  the  instantaneous  motion  of  the  platform.  In  this 

case  matrix  [c]  is  nonzero  singular  matrix. 

The  other  orthogonal  screws  and  are  linearly 

independent  but  this  two-system  is  linearly  dependent  on  that 

orthogonal  screw  - 1.75  Thus 

-*“0 1 -^o  1 -*-o  1 1 

matrix  [d]  becomes  singular.  Equation  (5.4)  reduces  to 


o 

t 

0 

o' 

'0.5  1.5 

1 — 1 

0 

2 

0 

6 -2 

0 

_0 

0 

1 

CN 

1 

ro 

_-ll  2 

-1  _ 

The  input  scalar  multipliers  are  dependent  and  therefore 
are  not  capable  of  controlling  the  end-effector  platform. 

By  locking  the  inputs,  the  system  will  be  identical 
to  that  illustrated  in  Fig.  5.10  (see  Case  III,  example 


(a)  ) . 
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m 


Figure  5.14.  Example  of  Case 
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Case  VI 

(a)  In  the  configuration  shown  in  Fig.  5.15  the  three 
subchains  meet  at  a single  point  (5  , 3)  and  the  three  screw 
systems  degenerate.  Therefore,  all  diagonal  elements  in 
matrix  [C]  vanish  simultaneously  and  matrix  [C]  becomes  a 
zero  singular  matrix.  Equation  (5.4)  reduces  to 


0 

0 

0 

1 — 1 

' — ' »-H 

3 

0.5 

1.5 

1 

0 

0 

0 

< 

6 

-2 

0 

0 

0 

0 

m 

-11 

2 

-1 

It  is  obvious  from  the  above  equation  that  a]J^  three  input 
scalar  multipliers 

assume  any 

values  and  therefore  all  three  independent  inputs  do  not 
have  any  control  on  the  instantaneous  motion  of  the  end- 
effector  platform. 

The  three  orthogonal  screws  and  are 

linearly  dependent  + 1.75  ^ ) and  therefore 

form  an  orthogonal  two-system  which  represents  the  unattain- 
able motion  of  the  end-effector  platform.  Thus  the  end- 
effector  platform  has  one  uncontrollable  freedom.  The  twist 

/N 

^ representing  this  instantaneous  motion  of  the  platform 
can  be  described  by  the  null  space  of  matrix  [D]  and 


i = 0.2  (a^) 


1 

3 

-5 
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Figure  5.15.  Example  of  Case  VI- (a) 
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Therefore,  this  uncontrollable  motion  of  the  end-effector 
platform  is  a twisting  motion  of  magnitude  (0.2  a;,^ ) , where 
a^  is  an  arbitrary  scalar,  about  an  axis  normal  to  the  plane 
and  passing  through  point  (5  , 3)  which  is  the  point  of 
intersection  of  the  three  subchains.  The  device  in  this 
configuration  is  said  to  be  in  a simple  uncertainty  con- 
figuration. 


(b)  For  the  configuration  illustrated  in  Fig.  5.16 
the  three  subchains  meet  at  a single  point  (3.5  , 3.5)  which 
is  the  center  of  the  third  joint  of  the  third  subchain  and 
the  three  screw  systems  degenerate.  Equation  (5.4)  reduces 
to 


•- 

0 

0 

0 

1 — 1 

' t-H 

0 1.5 

1.5 

0 

0 

0 

S 

II 

7 -1 

1 

0 

0 

0 

-5.25  0 

-1.5 

The  analysis  is  similar  to  that  of  the  previous  example  and 
the  end-effector  platform  has  one  uncontrollable  freedom 
which  is  a twist  of  magnitude  (0.286  ai)  about  an  axis  which 
coincides  with  the  axis  of  i.e.. 


r 1 

i = 0.286  (ai)  ) ^ ^ 

1-3.5 

The  device  is  also  in  a simple  uncertainty  configuration. 
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Figure  5,16.  Example  of  Case  VI- (b) 


CHAPTER  6 

DISPLACEMENT  ANALYSIS  OF  THE  THREE-DoF 
PLANAR  FLORIDA  SHOULDER 


6 . 1 Introduction 

The  location  (position  and  orientation) of  a rigid  body 
(or  Lamina  Z),  in  a general  co-planar  motion  can  completely 
be  defined  with  respect  to  the  fixed  plane  of  motion  by  three 
independent  coordinates  which  may  be  chosen  in  a variety  of 
ways.  For  example.  Fig.  6.1(a),  the  cartesian  coordinates 
(Xp,  Yp)  of  a reference  point  P fixed  in  the  body  and  an 
orientation  3p  of  an  arbitrary  line  in  the  plane  passing 
through  that  reference  point  constitute  three  degrees  of 
freedom  which  uniquely  define  the  configuration  of  the  body. 
Three  distinct  points  P,  Q,  and  R,  Fig.  6.1(b)  can  be  used 
to  locate  the  lamina.  They  constitute  only  three  independent 
parameters  since  the  six  parameters  are  related  by  the  follow- 
ing three  equations. 


= 

4 = 

L?  = 


(6.11 


Analogous  to  the  investigation  of  the  instantaneous  kine- 
matics, the  displacement  analysis  can  also  be  categorized  into 
two  types  of  analyses.  First  it  will  be  assumed  that  numeri- 
cal values  for  the  actuated  joint  displacements  are  known  and 
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X 


Figure  6.1.  Lamina  Z in  a General  Planar  Motion 
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it  is  required  to  compute  the  location  of  the  end-effector 
lamina.  This  will  be  called  the  forward  analysis ^ (analogous 
to  the  hand-location  analysis-II  of  single-loop  manipulators, 
[1]).  Secondly  it  will  be  assumed  that  it  is  required  to 
obtain  a set  of  joint  displacements  which  will  locate  the  end- 
effector  lamina  at  some  prespecified  position  and  orientation. 
This  will  be  called  the  reverse  analysis,  (analogous  to  the 
hand-location  analysis-I,  [l]). 

The  notation  developed  in  [l]  for  single-loop  manipulators 
is  adapted  here  to  analyze  the  planar  version  of  the  Florida 
Shoulder  illustrated  by  Fig.  6.2: 

is  the  link  connecting  the  ith  and  the  jth  joints 
in  the  nth  subchain, 

is  the  link  connecting  the  ith  joint  in  both  the 
nth  and  the  mth  subchains, 

is  the  exterior  angle  measured  about  the  ith 
joint  axis  in  the  jth  subchain. 


a . . 
ij  ,n 


1 , nm 


0 


J 


4)  . : is  the  angle  that  link  a.,.,,,  . makes  with 

the  horizontal  X-axis, 


and 


(Xf j ) : are  the  X and  Y coordinates  of  the  center  of 
the  ith  joint  in  the  jth  subchain. 

The  planar  sine,  sine-cosine,  and  cosine  laws  derived  in 
[l]  will  be  used  throughout  this  analysis  expressed  using  the 
above  modified  notation. 
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Figure  6.2.  Planar  Version  of  the  Florida  Shoulder 


213 


6 . 2 Forward  Analysis 

Here  it  is  assumed  that  numerical  values  are  known  for 
the  three  input  displacements  (<{),  .)  and  for  the  cartesian 

i 5 1 

coordinates  of  the  three  fixed  points  for  i = 1,2,3. 

It  is  required  to  compute  the  location  of  the  end-effector 
lamina,  i.e.,  determine  the  coordinates  of  the  three  points 
(X^^,  where  i = 1,  2,  3.  This  is  accomplished  by  com- 
puting the  joint  angles  i>  ^2  2'  ^2  3‘ 

Firstly  the  position  of  the  second  joint  in  each  sub- 
chain is  determined  from  the  following  pairs  of  expressions 


^2i 

+ 

^12 , i 

cos  d) , . 

1,1 

^2i 

= V 

+ 

^12 , i 

s in  d) , . 

1,1 

(6.2) 


where  i = 1,  2,  3. 

Following  this  three  hypothetical  links  a^  ^2'  ^2  23' 
and  ^2  21  drawn  which  connect  the  second  joints 


of  the  subchains  (see 

Fig.  6.3) 

and , 

2 

^2,  12 

+ 

(Y21 

-Y  ) ^ 
22^ 

2 

^2,23 

(X22-X23)' 

+ 

(Y22 

-Y  ) ^ 

23’ 

2 

^2,31 

(X23-X2,)2 

+ 

^^23 

-Y  ) ^ 

21’ 

(6.3) 

Further  the  interior  angles  62  and  3^  can  be  computed 


using  the  law  of  cosines  and 
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OD 


Figure  6.3.  Six-Bar  Structure 


2 

^2,12 
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2 

^2,31 


+ a 


cos  Bo  = 


2,23 


2 12^2,23 


cos  2 


3 = 


2 3 2 

^3, 12  ^ ^3,23  “ ^3,31 

2 a a 

3,12  3,23 


(6.4) 


In  this  way  the  determination  of  the  joint  displacements 
is  reduced  to  an  analysis  of  the  pin-jointed  structure  illus- 
trated in  Fig.  6.3  There  are  two  independent  loops  in  this 
structure  which  when  considered  separately  are  planar  four- 
bar  mechanisms.  The  exterior  angles  (6  , eij  ) and 


<®3.2’ 

0^  ) 
3,2' 

are  related  by  the 

following  expressions 

(see 

Fig.  6 

.4)  , 

®2,2  “ i2T\-Q^) 

“ ®2,2 

(6.5) 

®5,2  = 63  - ®3. 

2 

(6.6) 

Here  the  superscript  'b'  used  to  label  the  exterior  angle 
of  the  quadrilateral  (the  four-bar  mechanism)  illustrated 
in  Fig.  6 . 4 (b) . 

The  law  of  cosines  for  the  quadrilateral  (Fig.  6.4(a)) 
can  be  expressed  in  the  form 


^2,  12  ^^3, 2^2, 2"^  ^3, 2^2, 2^  ^3,2 


+ = (a23_,)V2 


(6.7) 


where  by  definition 


216 


Figure  6.4.  Two  Independent  Quadrilaterals 
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X 


3,2 


■3,2 


'3,2 


^3,12^3,2 

■^^23,2  ^3,12^3,2^ 

(a3, ^2^  /2  + (^23,2^ 

■*■  ^3,  12^23,  12^3,2 


(6.8) 


and  2 ^2  2 ®2  2 ®2  2'  ^^spectively . 

Substituting  (6.8)  in  (6.7),  then  (6.7)  can  be  expressed  in 
the  form 


where 


^S,2-^®lS3,2+^l  = ° 


^1  ^1^2,2 


^2^2,2 


^3*^2, 2 ■*■  ^3 


and 


(6.9) 


(6.10) 


^ ^2,12^3,12 
^ ^23,2^3, 12 

^2  ^ "^2,12^3,12"^  1 


a 


3 


d 


3 


^2, 12^23 , 2 

(a2_i2>V2  + (a23_2>V2  + 

(6.11) 


Similarly,  the  law  of  cosines  for  the  quadrilateral 
in  Fig.  6.4(b)  can  be  expressed  in  the  form 
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-a. 


(x^  s^ 

+ 

'^,2> 

23  3,2  2,2 

3,2 

^ (^2,23^'/2 

= (^23 

,3>'/8 

2^ 

3 , 2 


(6 


where  by  definition 


= ^,23  "^2 

^3,2  = "^^23,2  ^3,23  *^,2^ 

^l2  = (^,23)'/2  ^ (-23,2^'/2 


+ a a 

3,23  23,2  3,2 


Substitute  (6.13)  in  (6.12): 


(6 


^2,23^^3,23  ^3,2  ^2,2  ^^23,2  ^3,23  "'3 , 2 ' ^2 , 2 


" t(-3,23^'/2  - (-23, 2)'/^  " -3,23  ^2  3 , 2 2 ^ 


^ ("2,23)'/2  - (-23,3^'/2  = 0 


(6 


Using  (6.5)  and  (6.6),  , and  can  be 

^ t ^ ^ I Z Z f Z 2.  f z 

expressed  in  the  form 


^3,2  = "i"  63  S,2  - 63  S3_3 


S.2  = 83  €3^^  + sin  B3 


®2,2  = 63  C^^3  - COS  63  83^3 


S,2  = 83  =3^3  - sin  63  83^3 


(6 


Substituting  (6.15)  in  (6.14)  gives 


, + B S + D = 
2 3,2  2 3,2  2 


.12) 


.13) 


14) 


.15) 


0 


(6.16) 
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where 


^2  ^4^2,2  ^^4^2, 2 ^4 


®2  ^5^2,2  ^5^2,2  ■*■  ^^5 


°2  = ^6^2,2  ^ ^6^2,2  + ^6 


(6.17) 


and 


^4  ^ ^2,23^3,23^°®^^3~^2^ 

^4  ^ ^2,23^3,23®^^^^3~^2^ 

^4  ^ ^23,2^3,23^°®  ^3 

^5  ^ ^2,23^3,23^^"^^3"^2^  ^4 

^5  “^2,23^3,23'^°®^^3“^2^  "^4 


d^  = a 


5 ‘^23,2^3,23 


^6  ^2,23^23,2 


sin  6. 


cos  B, 


"^2,23^23,2®^’^  ^2 
" ^^2,23^^/^  ^ ^^23  2^^/^ 


3 , 23 


)V2  - (a,3_3>V2 


(6.18) 


"^he  two  equations  (6.9)  and  (6.16)  are  thus  of  the  form 


A.C 

J 


3,2 


+ B . S 
3 


3,2 


+ D.  = 0 
3 


(6.19) 


where  j 1,  2.  Eliminating  ^ snd  then  C^  2 f^oni  set 
(6.19)  yields  , 


3^2  = |bd|/|ab| 

(6.20) 

3^2  = -1ad|/|ab| 

(6.21) 
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where  | AB]  = (A^B2~A2Bj),  [ BD|  = (Bj^D2“B2D^ ) , and 
I AD|  = (Aj^D2~A2Dj^  ) . Squaring  and  adding  (6.20)  and  (6.21), 
and  rearranging  the  eliminant  of  set  (6.19)  can  be  expressed 
in  the  form 


|ab|^  - |AD|^  - |bd|^  = 0 (6.22) 


Using 

(6.10) , 

(6.11),  (6 

. 17) , and  (6 . 

00 
1 — 1 

AB 

= a'c 

2 ' 2 
2,2-^®  ^2 

1 

+c  s c 
,2  ^ ‘-2,2^ 

2,2+°'<^2,2-"^' 

^2,2-^^’ 

It 

2 " 

2 " 

tl 

It  If 

bd| 

= A 

S,2-^^ 

"2. 2-^^ 

^2,2^2 , 2'*'° 

S,2^^  ^2,2^^ 

tl  1 

2 " 

to  111 

ft  t 

M t 

AD  1 

= A 

S,2^^ 

"2.2^^ 

^2, 2^2, 2'^’^ 

'^2,2+^  22,2-^^" 

(6.23) 


and  equation  (6.22)  becomes 

+ FC^  ^ 2'^°®2 , 2'^2 , 2'^*’®  2 , 2^2 , 2'^’‘®2 , 2*^2 , 2’*''^®  2 , 2 


* ’'st2-^^sL2+“=2,2™''2.2+«  = ° 


(6.24) 


where 
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It  mo  m I 9 

A = A -A  -A 


B = 

1 f If  M !!!!!! 

: 2 (A  C -A  C -A  C ) 

C = 

II  ft  II  til  It  1 

: 2 (A  D -A  D -A  D ) 

D = 

? 1 MM  IM  MI  I 9 MO  Ml  2 

= 2(A  B -A  B -A  B ) + (C  -C  -C  ) 

E = 

It  II  It  III  tM  * T tl  II  II  1 II  1 

= 2 (A  E -A  E -A  E ) + 2 (C  D -C  D -C  D ) 

F = 

II  II  II  II 1 II 1 1 2 "2  »» » 2 

= 2 (A  F -A  F -A  F ) +D  -D  -D 

G = 

II  II  II  III  III 

= 2 (B  C -B  C -B  C ) 

H = 

It  MM  MI  MI  II  II  II  III  III 

= 2 (C  E -C  E -C  E ) +2(B  D -B  D -B  D ) 

I = 

II  II  II  II  1 II  1 II  II  II  II 1 II  1 

= 2 (C  F -C  F -C  F ) +2 (D  E -D  E -D  E ) 

J = 

1 9 II  9 II 1 9 

= B -B  ^-B 

K = 

II  II  II  III  III 

= 2 (B  E -B  E -B  E ) 

L = 

II  II  II  II 1 II 1 1 9 119  1119 

= 2(B  F -B  F -B  F ) + 2 (E  -E  -E  ) 

f T MM  ?1  T Ml 

M = 2 (E  F -E  F -E  F ) 


N = 

II  II  II  III  III 

= 2 (D  F -D  F -D  F ) 

Q = 

10  ”0  1119 

= F ^-F  ‘^-F  ^ (6.25) 

From  (6.11)  and  (6.18),  ~^2'  ^4  ~ ^5  ~ ^4’ 

Making  these  substitutions,  the  coefficients  in  the  right 
side  of  (6.25)  can  be  expressed  in  the  simple  form. 
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I I 


A 

= B = 

^5 

f 

C 

= 0 

? 

D 

= a^dj 

+ 

? 

E 

= ^i'34 

- 

^■*1 

T 

F 

= d^d3 

A 

1 

B 

I 

C 

I 

D 

I 

E 

I 

F 


”^3^5 


= -^1^6 


“‘^3^5  ^3^5 


= -a^d^  + d3a^ 


= -d3d3 


B 


= -C 
= 0 


= a^b^  - a3a^ 


^1^6  ■'■  '^1^6  *^3^4  " ^3^4 


= ^1^6  - 


~ *^3‘^4 


(6.26) 


Substituting  ^2,2"^~^22  ^2  2 " ^ “ ^^2  2 

in  (6.24)  and  rearranging  yields. 


+ C 


2,2 


{a  €2^2  + b C2^2''’^  ^2,2  ^ ^2,2 

"^2,2^^  *“2,2'''*^  *“2,2  '^^‘“2,2  (6.27) 
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where , 


a — A — D + J 
b = C - H 

c=D+F-L-2J 
d = H + N 
e = J + L + Q 
f = B - G 
g = E - K 
h = G + I 

i = K + M (6.28) 


Equation  (6.27)  can  be  expressed  as  an  eighth-degree 
polynomial  in  This  is  accomplished  by  squaring  (6.27) 


[a2+f2]c8^^  + [2(fg+ab)]cJ  ^ ^ [2(fh+ac)  +g^ 
+b^-f^]C^  +[  2 (f i+gh+ad+bc-fg) ] 

+ [2 (gi+ae+bd-fh) +h^+c^-g^l 

2,2 


+ [2 (hi+be+cd-fi-gh) ]C^  + [ 2 (ce-gi ) +i^+d^-h^ ] 

^ f ^ 2 


However,  the  number  of  assembly  configurations  of  the 
structure  illustrated  in  Fig.  6.3  can  be  determined  by  dis- 
connecting the  third  joint  in  the  second  subchain  and  by 
counting  the  number  of  points  of  intersection  of  the 
planar  coupler  curve  traced  by  the  four-bar  with  the 


and  making  the  substitution 


2,2 


+ [2(de-hi)]C2  2 ° 


(6.29) 
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circle.  Details  are  given  in  Appendix  A where  it  is  shown 
that  there  are  a maximum  of  6 real  intersections.  It  fol- 
lows that  the  coefficients  a and  f in  (6.29)  must  be  zero,  i.e., 

a = f = 0 (6.30) 


This  is  demonstrated  in  Appendix  B and  (6.29)  reduces  to 
the  following  sixth-degree  polynomial 


c + c + c + c 

6 2,2  5 2,2  4 2,2  3 2,2 


+ c„C„  » + c,C„  o + c = 0 
22,2  12,2  o 


(6.31) 


where, 

c^  = g + b 
c^  = 2 (gh+bc ) 

c^  = 2 (gi+bd)  + (h^+c^-g^) 

c^  = 2 (hi+be+cd-gh) 

= 2(ce-gi)  + (i^+d^-h^) 

Cj^  = 2 (de-hi) 

2 . 2 

c^  = e -1  (6.32) 


Equation  (6.31)  can  thus  be  solved  for  any  arbitrary  set 

of  mechanism  dimensions  which  can  yield  a maximum  of  6 real 

values  for  C . Corresponding  values  for  S„  „ can  be  com- 
^ ^ L ^ L 

puted  using  (6.27) , and  in  this  way  values  for  0„  „ are 
computed.  Following  this,  values  for  the  remaining  joint 
displacements  can  be  computed. 
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First,  values  of  the  exterior  angle  0 can  be  com- 

j , z 

puted  using  (6.20)  and  (6.21).  Following  this,  values  of 
the  exterior  angles  0^  ^ ®3  2 can 

be  computed  using  (6.5)  and  (6.6)  respectively 


0 


b 

2,2 


(2.-62)  -02,2 


0 


b 

3,2 


- 0 


3,2 


where  the  interior  angles  62  and  6^  are  expressed  in  (6.4). 

The  sine  and  sine-cosine  laws  of  the  four-bar  illustrated 
in  Fig.  6.4(a)  can  be  expressed  as  follows 


^32,2  ^23,1^2,1 

(6.33) 

Y32, 2 = a^3 ,1^2,1 

(6.34) 

where  by 

definition 

^32,2  ^ S,2^2,2  ■ ^3, 2^2, 2 

^32,2  = ^3,2^2,2  ^3, 2^2, 2 " ^2,12 

(6.35) 

and  X3_2 

and  Y3  2 are  expressed  in  (6.8).  Values  of 

the 

exterior 

angle  02  can  be  computed  from  (6.33)  and 

(6.34). 

Similarly,  the  sine  and  sine-cosine  laws  of  the 

second 

four-bar 

illustrated  in  Fig.  6.4(b)  can  be  expressed 

as 

follows 

c: 

32,2  ^23,3^2,3 

(6.36) 

— a C 

32,2  23,3  2,3 

(6.37) 
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where  by  definition 


X - X^ 

32,2  " 3, 2^2, 2 3,2  2,2 


,b 

'3; 

,b 


Y“  - X^  + Y^  P^  - 3 

32,2  " 3, 2^2, 2 3,2  2,2  2,23 


(6.38) 


and  2 ^ are  expressed  in  (6.13).  Values  of  the 

exterior  angle  0^  ^ b>e  computed  from  (6.36)  and  (6.37). 

The  sine  and  the  cosine  of  angle  that  the  hypothetical 
link  a2  23  niakes  with  the  horizontal  X-axis  (see  Fig.  6.5) 
can  be  expressed  as  follows: 


sin 


Y -Y 
23  22 

^2,23 


(6.39) 


cos 


X23-X22 

^2,23 


(6.40) 


where  (^32'  ^2  2^  ^^2  3'  ^2  3^  known  coordinates  of 

the  centers  of  the  second  joints  in  the  second  and  third  sub- 
chains and  given  in  (6.2).  Values  of  the  angle  can  be 
computed  from  (6.39)  and  (6.40). 

The  angles  2’  ^2  3 links  a^^ 

^23,2  ^23  3'  respectively,  make  with  the  horizontal 

X-axis  can  be  expressed  as  follows,  (see  Fig.  6.6): 


4>2,i  = ^^"®2,1^  ~ [TT-(a2  + 63)] 


U2  + 62  ©2,1 


♦2,2  = <’'-®2,2>  “2 


and 


‘*'2,3  ®2,3  °^2 


(6.41) 

(6.42) 


(6.43) 
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O 


Figure  6.5.  Determination  of  Angle  U2 
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Figure  6.6.  Determination  of  Angles  4>2, 
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Finally,  the  required  expressions  for  the  coordinates  of 
the  center  of  the  third  joint  in  each  subchain  can  be  ex- 
pressed as  follows  : 


3i 

^2i 

+ a„„  . cos 
23,1 

*2,1 

3i 

^2i 

+ a„_  . sin 

23 , 1 

*2.1 

(6. 

44) 

3. 

The 

coordinates 

«21'  ’^21' 

are  given 

by 

(6.2),  whilst  the  angles  (J)„  . are  given  by  (6.44). 

6 . 3 Reverse  Analysis 

A major  problem  in  the  operation  of  a robotic  device 
(manipulator)  controlled  by  a computer  which  is  directing 
the  end-effector  to  move  from  one  location  to  another  is  to 
obtain  sets  of  joint  displacements  for  specified  locations  of 
the  end-effector  platform.  The  location  of  the  platform  can 
be  specified  by  the  coordinates  of  the  three  points  (X^^/  Y^^) 
where  i = 1,  2,  3 (Fig.  6.2). 

The  reverse  analysis  for  fully-parallel  devices  can  be 
performed  separately  for  each  subchain.  Furthermore,  since 
the  planar  version  of  the  Florida  Shoulder  is  a symmetrical 
fully-parallel  device,  the  analysis  is  performed  only  once 
for  the  ith  subchain  which  can  be  any  subchain  in  the  device 
and  the  angular  displacements  of  the  joints  in  this  ith  sub- 
chain are  determined. 


Figure  6.7  illustrates  that  the  ith  subchain  can  be  con- 
sidered as  a two-degree  of  freedom  serial  open-loop  mechanism. 
The  third  joint  can  be  connected  to  the  housing  of  the  first 
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/ 

I 


Figure  6.7.  Two-Degree  of  Freedom  Serial  Arm 


231 


revolute  joint  by  a hypothetical  link  a . thus  forming  a 
closed  triangle.  The  dimension  of  the  closing  link  is  given 
by 

^31, i = (6.45) 

The  exterior  angle  (0j^  computed  from  sequen- 

tial solutions  of 

sln(0^_i-,fl_j)  = (Y3i-Yii)/a3i_i 

cos  (01  _ 3-4,;  _ 3)  = -(X33-Xi3)/a3i_3  (6.46) 

It  is  interesting  to  note  that  the  transformation  equations 
(6.45)  and  (6.46)  are  the  same  whether  the  second  joint  is 
a revolute  or  a prismatic. 

The  exterior  angles  ©2,1  ^ can  be  computed  using 

the  sine,  sine-cosine,  and  cosine  laws  for  the  planar 
triangle  illustrated  in  Fig.  6.7, 


^23, i^2, i 

- ^-5  1 -S,  . 

= 31 , 1 1 , 1 

(6.47) 

~ ^^12,1^^23 , i^2, 

" ^31,1^1,1 

(6.48) 

^^23,1^  ^^12, ^23,1^12,1*^2,1 

= (^3^^^)  /2 

(6.49) 

Firstly,  two  values  for  0 . are  computed 

Z , 1 

using  the  cosine  law 

(6.49).  These  values  define  two  distinct  closure  configura- 
tions for  each  subchain.  The  geometric  configurations  of 
these  two  closures  are  illustrated  in  Fig.  6.8.  Following 
this, a corresponding  pair  of  values  of  0 . is  computed  using 

(6.47)  and  (6.48).  Consequently,  a pair  of  values  of  the  re- 
quired angular  displacement  cj)  . can  be  computed  as  follows; 

J ^ 
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*i,i  = ®i.i  - 


(6.50) 


where  (0  •)  is  computed  using  (6.46). 

1,1  i » 1 

The  sine  and  sine-cosine  laws  for  the  same  planar  triangle 
(Fig.  6.7)  can  also  be  expressed  as  follows 


X„  . = a_,  .S„  . 

2,1  31,1  3,1 

Y„  . = a„,  .C„  . 

2,1  31,1  3,1 


where  by  definition 


X„  . = a,„  ,S„  . 

2,1  12,1  2,1 


Y = -(a  .+^10  -Co  .) 

2,1  23,1  12,i2,i 


(6.51) 

(6.52) 


(6.53) 


which  are  known  quantities.  Therefore  a corresponding  pair 
of  values  of  0.  . is  computed  using  (6.51)  and  (6.52). 

J , X 

Finally,  the  location  of  the  center  of  the  second  joint 
in  the  ith  subchain  can  be  determined  as  follows  (see  Fig. 
6.8)  , 


— In  the  first  closure: 


2i 

= ^li 

^12, 

i 

cos  (f),  . 

1,1 

2i 

= ^li 

^12, 

i 

sin  (1),  . 

1,1 

— In  the  second  closure : 


! 


X 


2i 


t 


Y 


2i 


» 


^11 

+ 

a . 

12,1 

cos  <p,  . 

1,1 

^li 

+ 

a,  „ . 
12,1 

f 

sin  d),  . 

1,1 
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Figure  6.8.  Closure  Configurations 
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6 . 4 Numerical  Examples 
Example  1 

The  sixth-degree  polynomial  (equation  (6.29))  was  veri- 


fied  by  choosing  a four-bar 
dimensions 

mechanism 

with  the 

following 

^23  1 ~ 2.46  in. 

^23 , 3 

= 2.49 

in. 

2]^  “ 1.253  in. 

^3,31 

= 1.315 

in. 

^3  12  ~ 2.98  Ln. 

^3,23 

= 3.337 

in. 

the  coupler  curve  for  which  is  illustrated  in  Fig.  6.9.  A 
pivot  point  P was  chosen  such  that  the  circle  with  radius 

^23  2 ~ 2.681  in. 

intersected  the  coupler  curve  in  six  real  points.  Following 
this,  the  three  fixed  pivot  points  were  chosen 


= 0 in. 

^11 

= 0 in. 

^2  = 6 in. 

^12 

= -2.305  in.. 

= 5.5  in. 

^13 

= 2.41  in. 

and  three  input  links  were  also  chosen 

^12  1 “ 

^12  2 ~ 3.05  in. 
^12,3 


3.5  in. 
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Figure  6.9. 


Six  Real  Points  of  Intersections 
of  Coupler  Curve  and  Circle, 
Example  6 . 1 
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The  input  actuated  joint  displacements 

= -20.984  deg. 

-1-  / 

4)  = 112.1616  deg. 

(j)  = -142.958  deg. 

X , J 

were  selected.  Equation  (6.29)  yielded  six  real  values  for 
©2  2 and  the  six  corresponding  configurations  of  the  lamina 
were  determined.  The  six  sets  of  coordinates  of  the  lamina 
sre  listed  in  Table  6.1  and  the  corresponding  six  assembly 
configurations  are  illustrated  in  Figs.  6.10-6.12.  In 
this  way  the  sixth-degree  polynomial  is  verified.  The  sixth 
set  was  used  to  perform  a reverse  analysis  and  eight  sets 
of  joint  displacements  are  listed  in  Table  6.2.  The  eighth 
set  of  Table  6.2  is  in  exact  agreement  with  the  input  for 
the  forward  analysis  which  verifies  that  both  forward  and 
reverse  analyses  are  correct.  Further,  the  corresponding 
assembly  configurations  are  illustrated  in  Fig.  6.13  and 
the  assembly  configuration  drawn  with  the  broken  lines  is 
identical  to  the  sixth  configuration  shown  in  Fig.  6.12. 

Example  2 

Ihe  reverse  analysis  was  used  to  determine  a sequence 
of  actuator  input  angles  which  would  rotate  the  end-effector 
lamina  of  the  device  illustrated  in  Fig.  6.14  about  an  axis 
normal  to  the  lamina  and  passing  through  point  (4.25,7.145). 
Plots  of  one  branch  of  the  input  angles  (4>  , cj)  , and 

*^1,3^  angle  of  rotation  (y)  are  shown  in  Figs.  6.15- 


6.17. 


Table  6.1 

The  Coordinates  of  the  End-Effector  Lamina 
and  the  Correspondinq  0„  „ 
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CM 


Figure  6.10.  Configurations  1 and 
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X 


Figure  6.11.  Configurations  3 and 
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Figure  6.12.  Configurations  5 and  6 


Table  6.2 

The  Required  Sets  of  Joint  Displacements 
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Figure  6.13  Six  Assembly  Configurations, 
Example  6.1 
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Figure  6.14.  Planar  Florida  Shoulder, 
Example  6.2 
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Figure  6.15.  Input  Angular  Displacement  4)^^  ^ , Example 


180 
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Figure  6.16.  Input  Angular  Displacement  2 » Example 
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Figure  6.17.  Input  Angular  Displacement  4*1,3/  Example 
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Computer  programs  and  listings  of  the  printed  results  of 
this  chapter  are  presented  in  Appendix  C. 


CHAPTER  7 

THE  REVERSE  JOINT  DISPLACEMENT  ANALYSIS  OF 
SPATIAL  FULLY-PARALLEL  DEVICES 

7 . 1 Introduction 

The  major  problem  in  the  operation  of  a manipulator  con- 
trolled by  a computer  which  is  directing  the  end-effector  to 
move  from  one  position  to  another  is  to  obtain  a set  of  joint 
displacements  which  will  position  the  end-effector  at  a given 
point  with  a specified  orientation  within  the  working  space. 
As  mentioned  in  the  previous  chapter  this  analysis  is  called 
the  reverse  joint  displacement  analysis,  or  simply  the  re- 
verse analysis.  The  reverse  analysis  of  a niomber  of  some 
practical  six-degree  of  freedom  spatial  robotic  devices  is 
presented  in  this  chapter. 

The  location  of  the  end-effector  platform  can  be  speci- 
fied by  a point  q in  the  platform  and  by  the  orientation  of 
the  platform.  The  orientation  of  the  platform  can  be  con- 
veniently specified  by  the  direction  cosines  of  a moving 
coordinate  system  (x,y,z)  attached  to  the  platform  and  ex- 
pressed in  terms  of  a reference  coordinate  system  (X,Y,Z). 

For  simplicity  and  without  losing  generality  let  the  origin 
of  the  moving  coordinate  system  x,  y,  z be  chosen  coincident 
with  point  q. 
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The  location  of  the  end-effector  platform  can  be  speci- 
fied by  a transformation  matrix  [a] , 


[A]  = 


(7.1) 


where  (X  ,Y  , Z ) are  the  coordinates  of  point  q in  the 
H M.  ^ 

fixed  coordinate  system  and  [t  ] is  a matrix  of  direction 
cosines  of  the  moving  coordinate  system. 


7 . 2 The  Reverse  Analysis  of  the  R-P-SP 

Device  with  Three-Subchains  (Fig.  3.27) 

Figure  7.1  illustrates  the  skeletal  form  of  the  R-P-SP 
device.  The  centers  of  the  base  revolute  joints  0^,  where 
i = 1,  2,  3, are  at  the  mid-points  of  the  sides  of  an  equi- 
lateral triangle  with  length  'a'.  Local  reference  coordinate 
systems  ^ ^ ^ chosen  for  which  the  Z^-axis  is 

coaxial  with  the  revolute  axis  and  the  Yi-axis  is  normal  to 
the  base.  Without  loss  of  generality, a fixed  reference  co- 
ordinate system  (X,Y,Z)  is  selected  coincident  with 

distribution  of  the  sliding  grooves  in  the 
platform  are  symmetrical  as  illustrated  in  Fig.  7.1. 

The  location  of  point  q can  be  expressed  in  terms  of  any 
one  of  the  local  fixed  coordinate  systems  by 
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Figure  7.1.  Coordinate  Systems  for 
the  R-P-SP  Device 
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R. 

— 1 


1 


(7.2) 


where 


[B]  = 


cosg^ 

0 

sinB . 


0 

1 

0 

0 


■sinB.  -X  .cosB.+Z  .sinB. 

X oi  1 ox  X 

0 ^ -Y  . 

I ° ^ 

cosB.  I -X  .sinB.-Z  .cosB. 

XI  ox  X ox  X 


(7.3) 


and  (Xq^ , , Z^^ ) are  the  coordinates  of  the  origins  0^  in 
terms  of  the  reference  coordinate  system.  Angle  B^  between 
the  local  and  the  reference  coordinate  system  is  illustrated 
in  Fig.  7.1. 

The  direction  cosines  of  the  sliding  axes  where 

i = 1,  2,  3,  in  the  moving  coordinate  system  (x,y,z)  are 


(7.4) 


and  therefore  the  direction  cosines  of  in  terms  of  the 

local  fixed  coordinate  system  (X^,Y^.Z^),  for  i = 1,  2,  3, 
can  be  expressed  as  follows: 
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cosB^ 

0 

-sinB . 
1 

\ siny,.  ) 

c(i)  _ 
-6  " 

0 

1 

0 

[Tq] 

0 

sinB^ 

0 

cosB^ 

/ COSY . , 
' 1 / 

where  for  the  configuration  illustrated  in 

Fig.  7.1, 

= 0 deg. 

^2  = 

120  deg 

• ^3  = 

240 

deg. 

= 0 deg. 

^2  = 

120  deg 

• ^3  = 

240 

deg. 

X = 0 

0 1 

^02  = 

ayi/4 

^03  = 

a/374 

0 

II 

0 

Y 9 = 

0 2 

0 

^03  = 

0 

Z = 0 

0 1 

Z 0 = 
o2 

a/ 4 

^03  = 

-a/4 

(7.5) 


Each  subchain  can  be  considered  to  be  adjustable  and 
individually  controllable.  The  analysis  can  be  performed 
separately  for  each  subchain.  It  is  required  to  express 
the  vectors  R^,  and  (see  Fig.  7.2)  in  terms  of 

the  ith  subchain  fixed  coordinate  system  (X^,Y^,Z^).  Further, 
since  the  analysis  can  be  repeated  for  each  subchain,  the 
superscript  (i)  is  superfluous  and  will  not  be  used.  The 
direction  cosines  of  the  revolute  and  prismatic  joints 
and  £2  can  be  expressed  as  follows 

0 I 

0>  (7.6) 

1 


and 
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Figure  7.2.  The  ith  Subchain  of  the  R-P-SP 
Spatial  Device 
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1 =^"*1  ] 

) \ 

1 

> = < 

1 coscj)^  / 

1 

\ i 

0 ) 

since  is  the  angle  from  to 

mutual  perpendicular  vector  £^2' 


measured  about  the 
U),  and  = f’'. 


The  location  of  point  q can  also  be  expressed  in  the 
vector  form 


R.  = (7.8) 

where  is  determined  by  (7.3).  It  is  required  to  determine 

the  variable  slider  displacements  s and  s^  together  with 

2 6 

the  vector  . This  is  accomplished  by  forming  the  inner 
product  of  (7.8)  with  which  yields 


R. 

—1 


§1  = -Sg(S^  . S^) 


(7.9) 


and  are  perpendicular,  and  therefore  (S^  • = 0. 

Solving  (7.9)  gives 


-(Ri  . S^) 

^^6  • §1^ 


(7.10) 


where  and  ^ are  given  by  (7.6)  and  (7.5),  respectively. 

It  is  apparent  from  (7.9)  that  when  becomes  perpen- 
dicular to  S^,  it  also  becomes  perpendicular  to  R where  s 

— i 6 

cannot  be  infinity  in  practice.  It  is  also  apparent  from 
(7.10)  that  when  this  happens  the  order  of  the  screw  system 
joints  in  the  subchain  reduces  instantaneously  and 
the  device  is  in  a special  configuration  (see  Cases  V and 
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VI,  Chapter  5).  Neither  the  rotating  displacement  nor 
the  sliding  displacement  S2  has  any  effect  on  the  motion  of 
the  platform  and  therefore  s^  can  assume  any  value. 

Following  this,  (7.8)  can  be  rearranged  in  the  form 


^6^6  = (^22+32)32 


(7.11) 


and  hence  can  be  determined  by 


-2  " 


(7.12) 


where  R.  + s,S,  is  the  norm  of  the  resultant  vector, 
(R^+SgS^) . The  direction  cosines  of  S2  determined  by  (7.12) 
can  now  be  used  to  compute  the  revolute  actuator  displacement, 
(})  ^ , and  from  (7.7)  , 


sin  (1)^  = -(S^ 


and 


cos  (j)j,  = S2 


0 

1 

0 


(7.13) 


(7.14) 


Finally,  sliding  actuator  displacement,  S2,  can  also  be 
computed  using  (7.11)  and. 


s„  = R.  + s,S, 
l " —1  6—6 


- S 


22 


(7.15) 


where  S22  is  the  prespecified  offset  associated  with  the 
prismatic  (sliding)  joint  P2 . 
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Numerical  Example 

The  R-P-SP  device  illustrated  in  Fig.  7.1  was  considered. 
The  reverse  analysis  was  used  to  determine  a sequence  of  ac- 
tuator input  angles  (})^  as  well  as  of  sliding  input  displace- 
ments s^  which  would  rotate  the  end-effector  platform  about 
the  y-axis  by  angle  a . 

Substituting  the  values  of  the  direction  cosines  of  R. , 
§-1'  and  given  by  (7.3),  (7.6),  and  (7.5)  in  (7.10)  and 

expanding,  yields 


cos  (a+Yi-6i  ) 


where  a is  the  angle  of  rotation  about  the  y-axis.  It  should 
be  noted  that  only  the  denominator  of  (7.16)  is  a function  of 
a.  It  follows  that  as  a varies  within  the  range  0 < a <2tt 
then  the  sign  of  Sg  will  change.  For  the  example  chosen  here 
Yi  = 6^  and  the  denominator  reduces  to  cos  a.  The  coordinates 
of  point  q were  = 2 in.,  = 14  in.,  and  Zg  = 5 in.  The 
constant  offset  for  each  of  the  three  subchains  was  S„  =3 

2 f 2 

in.  and  the  side  of  the  equilateral  base  was  a = 15  in. 

Plots  of  the  input  angles  (cj)  and  ,)  as 

well  as  of  the  input  sliding  displacements  (s„  , , s„  , 

2,1  2,2 

^2,3^  angle  of  rotation  (a)  are  shown  in  Figs. 

7. 3-7. 8. 

It  is  apparent  from  Figs.  7. 3-7. 9 that  the  device  is  in 
a special  configuration  when  either  a = 90  deg.  or  a = 270 
deg.  The  sliding  displacement  Sg  was  arbitrarily  chosen 
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Figure  7.3.  Input  Angular  Displacement  c|)i  i for 
the  R-P-SP  Device 
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3 


Figure  7.4.  Input  Angular  Displacement  (pi  2 for 
the  R-P-SP  Device 
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Figure  7.5.  Input  Angular  Displacement  4)]^  3 for 
the  R-P-SP  Device  ' 
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Figure  7.6.  Input  Sliding  Displacement  s,  i for 
the  R-P-SP  Device  ' 
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Figure  7.7.  Input  Sliding  Displacement  S2  2 
the  R-P-SP  Device 
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Figure  7.8.  Input  Sliding  Displacement  t for 
the  R-P— SP  Device  ' 
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Figure  7.9.  Sliding  Displacement  S6,i  for  the  R-P-SP  Device 
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to  be  zero  at  these  two  instances.  Because  of  the  symmetry 
of  the  device  (Yi  ~ = 120 (i-1)),  the  order  of  each  of  the 

screw  systems  of  the  three  subchains  reduces  instantaneously 
and  the  device  is  in  an  uncertainty  configuration.  Case  VI, 
Chapter  5 . 

Figure  7.9  illustrates  that  any  one  of  the  three 
sliding  displacements  S5  is  different  in  sign  from  the  other 
two . 

Clearly  this  device  is  not  suited  to  perform  tasks 
requiring  360°-rotations  of  the  end-effector  platform  since 
the  radius  of  the  platform  will  be  of  the  order  of  5 ft. 

7.3  The  Reverse  Analysis  of  Stewart  Platform 

(Fig.  3.29Y  ^ “ 

For  simplicity  and  without  losing  generality,  both  the 
end-effector  platform  and  the  fixed  base  are  chosen  to  be 
circular  with  radii  r^^  and  r2 , respectively  (see  Fig.  7.10). 
The  distribution  of  the  ball-and-socket  joints  are  chosen  to 
be  symmetrical  in  both  the  platform  and  the  base.  The  refer- 
ence coordinate  system  X,Y,Z  is  selected  such  that  its  orign 
is  at  the  center  point  0 of  the  base  with  the  Z-axis  passing 
through  the  center  of  the  first  ball-and-socket  joint,  i.e., 
through  point  Q^,  and  the  Y-axis  is  normal  to  the  base.  The 
moving  coordinate  system  x,y,z  is  selected  with  the  origin 
at  the  center  point  q of  the  platform,  the  z-axis  passing 
through  the  center  point  q^  of  the  seventh  ball  joint,  and 
the  y-axis  normal  to  the  end-effector  platform. 
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Figure  7.10.  Coordinate  Systems  for 
Stewart  Platform. 
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As  explained  in  section  7.2,  since  each  subchain  is 
adjustable  and  individually  controllable,  the  analysis  will 
be  performed  separately  for  each  subchain.  It  is  required 
to  express  the  coordinates  of  both  points  and  in 

terms  of  the  ith  subchain  fixed  coordinate  system  Xi , Yi , Z 
The  location  of  the  center  point,  q^ , of  the  ball-and 
socket  joint  (for  i=l,  2,  ...,  6)  in  terms  of  the  moving 
coordinate  system  x,  y,  z can  be  expressed  as  follows 


Therefore  the  location  of  q^  on  the  end-effector  Platform 
can  be  expressed  in  terms  of  the  fixed  local  coordinate 
system  by 


(7.17) 


(7.18) 
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where  (X^,  Y^,  Z^)  are  the  prespecified  coordinates  of  the 
center  point  q of  the  platform,  and  [t^]  is  the  prespeci- 
fied matrix  of  direction  cosines  (see  equation  (7.1)). 
Because  of  the  symmetry  of  the  distribution  of  the  ball 
joints  on  the  platform  and  the  fixed  base,  then 

= 6^  = 60(i-l)  deg.  (7.19) 

and  the  transformation  matrix  [b],  (7.3),  reduces  to 


cosB^ 

0 

-sinB . 
1 

1 0 

1 

[B]  = 

0 

1 

0 

i 0 

1 

(7.20) 

sinB^ 

0 

cosB^ 

1 '^2 

0 

0 

0 

1 

for  i = 1,  2,  . 

• • f 6 • 

The  direction  cosines 

of  the 

sliding 

axis  S4 

in 

the  ith 

subchain  can  be 

expressed 

in  terms 

of  the 

X. , Y. , 
1 1 

Z . 
1 

coordin 

ate  system  as  follows 


(7.21) 
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where,  from  (7.18) 


(7.22) 


and  llq^ll  is  the  norm  of  which  is  the  distance  between 


points  and  q^. 

It  is  necessary  to  control  or  actuate  a single  joint  in 
each  of  the  six  subchains.  Two  cases  are  now  considered. 

7.3.1  Case  I — The  Sliding  Joint  Is 


For  this  case,  (see  Fig.  7.11),  the  required  input 
sliding  displacement  s^  can  directly  be  computed  from  (7.18) 
and  (7.22)  as  follows 


where  is  the  prespecified  offset  associated  with  the 

sliding  (prismatic)  joint  in  each  subchain. 

7.3.2  Case  II — A Revolute  Joint  Is 
Actuated 

The  ball-and-socket  joint  at  the  base  can  be  simulated 
by  three  co-intersecting  revolute  joints  which  are  mutually 
perpendicular  and 


Actuated 


44 


(7.23) 


oti2  = ^22  ~ deg. 


a 


12 


a 


23 


0 in . 


S 


11 


S 


22 


S 


33 


0 in. 


(7.24) 
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Figure  7.11.  The  ith  Subchain  of  Stewart  Platform 
with  Actuated  Sliding  Joint 
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The  first  revolute  joint  is  assumed  to  be  the  input-actuated 
joint  and  the  angle  (f)^  between  a^^  the  local  X^-axis, 

measured  in  the  right-hand  sense  about  , is  the  required 
input  angular  displacement  (see  Fig.  7.12). 

There  are  seven  freedoms  in  each  subchain  and  one  of 
them  is  a spinning  freedom  (see  Fig.  3.23(f)).  Therefore, 
the  axes  of  rotation  and  are  collinear  which  form  the 
spinning  axis  and  they  are  parallel  to  the  axis  of  transla- 
tion S . Therefore, 

—4 

“34  = 0 (7.25) 

The  direction  cosines  of  S, , which  are  identical  to  the 
direction  cosines  of  , can  be  expressed  in  terms  of  the 
local  coordinate  system  as  follows: 


^4  = 


(7.26) 


Expanding  X*^^,  and  (see  Table  3.7  (ll),  and  making 


the  substitutions  a 


12  = ^‘23  “34  = 0 » yields 


sin  0^  cos  (j)^ 


§. . = < sin  0 sin  (j> 


2 ■■  '^1 

-cos  0 


(7.27; 


Equating  the  expressions  of  the  direction  cosines  of  S 

—4 

given  by  (7.21)  and  (7.27),  two  values  for  angle  0^  can  be 


computed  using 
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Figure  7.12  The  ith  Subchain  of  Stewart  Platform 
with  Actuated  Revolute  Joint 
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COSG2  = -Zj_/|lqj_|l 


(7.28) 


These  values  define  two  distinct  configurations.  Following 
this,  a corresponding  pair  of  values  of  the  required  angular 


7.3.3  Numerical  Examples 

The  Stewart  platform  illustrated  in  Fig.  7.10  was 
considered.  The  reverse  analysis  was  also  used  to  determine 
a sequence  of  the  input  displacements  which  would  rotate  the 
end-effector  platform  about  the  y-axis  continuously  by  angle  a. 
The  radii  of  both  the  end-effector  platform  and  the  circular 
base  were  chosen;  r^^  = 8 in.  and  = 10  in.  The  coordinates 

of  point  q were  X = 3 in.,  Y =18  in,,  and  Z =6  in. 

q q q 

Two  different  cases  were  considered. 

1.  The  prismatic  joint,  P^,  in  each  subchain  was  con- 

sidered to  be  the  input  actuated  joint  and  its  constant 
offset  was  = 5 in.  Plots  of  the  input  sliding  displace- 
ments (s,  .,  for  i=l,  2,  ...,  6)  vs  the  angle  of  rotation 

(a)  are  shown  in  Fig.  7.13. 

2.  The  base  revolute  joint,  , (see  Fig.  7.12)  in 

each  subchain  was  considered  to  be  the  input  actuated  joint. 
Plots  of  the  input  angular  displacements  (c^)^  .,  for  i = 1,2, 

...,  6)  vs  the  angular  rotation  (a)  are  shown  for  the  first 


displacement  ())j^  is  computed  using 

cos(J)j^  = X^/(||q^||  X sin02) 


(7.29) 
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Figure  7,13.  Input  Sliding  Displacement  s.  . for  Stewart  Platform 
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and  the  second  branches  of  <j)  . in  Figs.  7.14  and  7.15 

1/1 

respectively.  The  angular  displacement  (p  vs . a is 
shown  for  both  branches  in  Fig.  7.16. 

this  device  is  better  suited  to  perform 
tasks  requiring  360*^-rotations  of  the  end-effector  platform. 
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Figure  7.14.  Input  Angular  Displacement  4>i,i  of  the  First 
Closure  for  Stewart  Platform 
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Figure  7.15,  Input  Angular  Displacement  of  the  Second 

Closure  for  Stewart  Platform 
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Figure  7.16.  Input  Angular  Displacement  of  the  First 

and  the  Second  Closures  for  Stewart  Platform 


CHAPTER  8 

SUGGESTIONS  FOR  FUTURE  WORK 

There  are  two  distinct  areas  in  which  future  work  can 
be  carried  out.  The  first  deals  with  the  joint  displacement 
analysis  of  parallel  devices.  The  analysis  performed  in 
Chapter  7 was  a reverse  analysis.  There  is  a need  to  investi- 
gate the  forward  analysis  which  is  a more  difficult  task 
since  it  involves  the  solution  of  a set  of  highly  nonlinear 
simultaneous  equations.  The  forward  analysis  presented  for 
the  six-bar  structure  illustrated  in  Chapter  6 (Fig.  6.6)  can 
be  extended  and  applied  to  the  one-degree  of  freedom  planar 
Stephenson-3  linkage  which  is  also  must  have  a maximum  of 
six  assembly  configurations.  Furthermore,  the  joint  dis- 
placement analyses  of  partially-parallel  devices  such  as 
those  illustrated  in  Figs.  1.5,  3.8(b),  and  3.11(b),  which 
are  sometimes  incorporated  in  earth-moving  machines,  are 
also  needed. 

The  second  area  of  future  research  is  a study  of  the 
instantaneous  kinematics  of  parallel  devices.  In  this  dis- 
sertation six  different  types  of  special  configurations  for 
fully-parallel  devices  were  described  and  it  was  concluded 
that  certain  configurations  must  be  avoided.  The  next  logi- 
cal step  would  be  to  implement  the  given  strategy  (analysis) 
in  practice  and  to  search  for  mechanisms  with  special 


278 


279 


dimensions  that  may  avoid  such  special  configurations.  The 
behavior  of  mechanisms  close  to  special  configurations  needs 
to  be  understood. 


APPENDIX  A 


ASSEMBLY  CONFIGURATIONS  OF  THE 
STRUCTURE  ILLUSTRATED  IN  FIGURE  6.3 


The  order  of  the  polynomial  (6.29)  is  determined  by  the 


maximum  number  of  possible  assembly  configurations  of  the 
structure  illustrated  in  Fig.  6.3  which  has  been  redrawn 
(Fig.  A.l).  The  structure  can  be  disconnected  at  the  third 
pin  joint  of  the  second  subchain.  A point  C on  the  end- 
effector  lamina  will  trace  a four-bar  coupler  curve  and  the 


point  C on  link  ^ will  trace  a circle  centered  at 

. The  number  of  assembly  configurations  is  thus 
determined  by  the  mamber  of  real  intersections  of  the  coupler 
curve  which  is  of  order  6 with  the  circle  which  is  of  order  2. 
Using  Bezout's  theorem  (Primrose  [45]  Chapter  5),  one  would 
expect  that  there  would  be  a maximum  of  6x2  = 12  points  of 
intersections.  However,  this  is  not  the  case  because  both 
the  circle  and  the  coupler  curve  contain  the  imaginary  cir- 
cular points  at  infinity. 

The  basic  material  of  this  appendix  can  be  found  in 
several  standard  texts  such  as  Hunt  [3],  Primrose  [45], 
and  Salmon  [46]. 

Briefly,  the  equation  for  the  circle  generated  by  point 


C can  be  expressed  in  homogeneous  coordinates  in  the  form 


The  line  w = 0 is  called  the  line  at  infinity.  Substuting 
= 0 in  (A.l)  yields 


(x-wX22)^  + (y-wY22)^  ~ ^^^23  2^^  ^ ^ 


(A.l) 


2 2 
X + y^  = 0 


(A. 2) 


or 


X = ±iy 


(A. 3) 
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circle  traced 
point  C 


Figure  A. 1 Intersection  of  Coupler  Curve 
with  Circle 
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The  circle  thus  meets  the  line  at  infinity  in  the  two  imagin- 
ary  points  (A. 3)  which  are  called  the  imaginary  circular 
points  at  infinity.  Since  the  circle  contains  both  imagin- 
ary circular  points  once,  the  circle  is  said  to  have  a cir- 
cularity of  one. 

The  equation  of  the  coupler  curve  generated  by  point  C 
can  be  expressed  in  the  form 


2 2 2 
+ V = W 


(A. 4) 


where  in  terms  of  homogeneous  coordinates 


^3 


Uwa23^3)^  - (x^+y^+(wa^  23^^^^ 


(x^+y^+ (wa 


3 , 23 


W = 2 w a3  ^2a3  23[{x(x-wa 
2 

-yw  a^  3j^cosB] 


(A. 5) 


Substituting  w = 0 in  (A. 4)  yields 


0 


(A. 6) 
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Therefore,  there  is  a triple  intersection  of  the  coupler 
curve  with  the  line  at  infinity  in  the  imaginary  circular 
points  at  infinity.  It  follows  that  the  coupler  curve  and 
the  circle  must  intersect  three  times  in  the  two  imaginary 
circular  points  at  infinity.  Thus  they  can  intersect  one 
another  at  no  more  than  (12- (3x2))  = 6 other  points  in  the 
x-y  plane  and  these  six  points  themselves  may  be  real, 
coincident,  or  complex. 

It  can  now  be  concluded  that  the  number  of  assembly 
configurations  of  the  structure  in  Fig.  6.3  is  of  maximum 
six  and  therefore  the  order  of  the  polynomial  (6.29)  is 
only  six. 


APPENDIX  B 


REDUCTION  OF  COEFFICIENTS  'a'  AND  'f 
OF  EQUATION  (6.27) 


The  coefficient  A in  (6.24)  can  be  expressed  as  follows 


(see(6.25) ) 


f 9 M 9 u?  9 

A = A -A  -A 


(B.l) 


Using  the  expressions  in  (6.10),  (6.18),  and  (6.26),  the 

coefficient  A can  be  expressed  as  follows 

A=  - (-8333) 2 - (8333-3334) 2 

_22  22  22  22,  „ 

— a. a.  ~ a„a_  — a, a,  — a_a,  + 2a,a-a_a, 

15  35  16  34  1634 

_ 1 1 2 2 ■ ^ ,0  Q \ 

2,12  3,12^2,23^3,23®^^  (^3-62^ 

2 2 2 2 

^2,12^23,2^2,23^3,23®^^  ^^3“^2^ 

2222  2_ 

®2, 12^3, 12^2, 23^23, 2^^°®  ^2 

®2, 12^23, 2®2, 23^3, 23*^°® 


'''  ^®2, 12^3,  12^2, 23^23, 2^3, 23^°®^2^°®^®3  ^2^ 


(B.2) 


which  reduces  to 

A = 222 

2 ,12^23 , 2^2 ,23^3 ,23 

^2  ^2  2 2 2„ 

2,12  3,12^2,23^23,2^°®  ^2 

®2, 12^3, 12^2, 23^3, 23®^^  (63-82) 

^^2, 12^2,23^23,2^3, 12^3, 23°°®^2°°®^^3~^2^  (B.3) 

Also,  the  coefficient  D can  be  expressed  as  follows 


» ! II  If  U I Ilf 


D = 2(A  B -A  B -A  B ) + (c'^-c"^  -c'"^)  (B.4) 


2 S 6 
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Using  equation  (6.26)  and  the  relations,  a^^  = -h^,  a^  = , 

and  a^  = , the  expression  of  D can  be  expressed  in  the  form 


2 2 

D = 2{a,a_  - a„a^a,b,} 
1 5 3 5 1 6 


, / 2 2 2 2 ^ „ 2,  2 
+ {-a, a,  - a_a,  + 2a-a,a,a,  - a,b, 
16  34  3614  16 


2 2 

- a.a^  + 2a,a-a^b,} 

j J i J 3 O 


(B.5) 


Substituting  the  expressions  in  (6.10)  and  (6.18)  in  (B.5), 
(B.5)  reduces  to 

° ^ ^^2,12^3,12^2,23^3,23®^’^  ^®3“^2^ 

_ 2 2 2 2 

^2, 12^3, 12^2,23^23,2 

2 2 2 2 

^2, 12^3,23^2,23^23,2 

+ 2a2  ^ ^2^2 , 23^23 , 2^3  , 12^3 , 23^^°®^2^°®  ^^3"^2^  (B.6) 

Following  the  same  procedure  the  coefficient  J can  be 
expressed  in  the  form 

'2  "2  II I 9 

J = B -B^  - B ^ 


2 2 2,  2 

= *1*5  - *1^=6 


(B.7) 


and  substituting  the  expressions  in  (6.10)  and  (6.18)  in 
(B.7)  yields 


^2,12^3,12^2,23^3,23®^’^  ^^3  ^2^ 

2 2 2 2 . „ 

2,  12^3,  12^2,2  3^2  3,2®^’^^2 


(B.8) 
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Finally,  substituting  the  above  expressions  of  A,  D, 
and  J,  i.e.,  (B.3),  (B.6)  and  (B.8),  in  the  epxression  of 

the  coefficient 

a=A-D+J  (B.9) 

then  (B.9)  reduces  to  zero 

^ ^“^2,12^23,2^2,23^3,12^®^^  B2+COS  62) 

2 2 2 2 
2, 12^23,2^2,23^3, 12 

= 0 (B.IO) 


Following  the  same  procedure,  B and  G can  be  expressed 
as  follows 

t T If  It  Iff  Iff 

B = 2 (A  C -A  C -A  C ) 

2 2 

= 2 {-a, a-a^a ,+a.a, a^-a, a ,b , 

1356  345  166 

+ aj^a^aga^+  a^^a^a^b^  - a^a^a^}  (B.ll) 


which  reduces  to 

B = 2{-aJa^b^+aja3a^b^} 

and 

If  It  It  Ml  IM 

G = 2 (B  C -B  C -B  C ) 

reduces  to 

G = 2{-aJa^b^+a3a3a^b^) 
Therefore,  from  (B.12)  and  (B.14), 


(B.12) 


(B.13) 


(B.14) 


f = B - G 


0 


(B.15) 
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8 2 2 

The  coefficient  of  C2  2/  ^ equation  (6.29) 

clearly  vanishes.  Similarly,  the  coefficient  of  2' 

(=  2fg+2ab) , vanishes.  Since  there  are  no  further  reductions 
in  the  coefficients,  it  can  be  concluded  that  the  polynomial 
(6.29)  is  of  order  6 which  is  in  agreement  with  the  result 
deduced  in  Appendix  A. 


APPENDIX  C 


COMPUTER  PROGRAMS  AND  RESULTS 
OF  CHAPTER  6 


The  programs  used  to  perform  the  analysis  and  to 
generate  the  data  for  the  plots  of  Chapter  6 are  stored 
in  the  Harris  computer  of  the  CIMAR  computer  system  under 
workspace  3010DT7*PHD. 
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7 P06I6[Dj  V 

V Z^POLYb 
[Ij  SAA-^A  + J-D 
[2J  SF^B-G 

l3]  CB-^k'\SG-^E-K)*2)^{SB^C-U)*2 

[4  j C’5-^2x^5Gx5//^£;+I)  + 5flx5^7-^-^l+F-L^■2  xc/ 

[ 5 j CUr-^{2y-'^SG^SI^K+M)  + SB^SD^H+N)  + {SH*2)^'^SC*2)-SG*2 
[ 6 j C3-^2  X ( 5Px  5J  ) + ( SBxSE->-J+  L+Q) -r  SC^  SD)  - SG><^  SH 

[7  J 6’2^(  2x'5Cx5£)  -55x51)  + (51  *2  ) + { SD*2  ) - SH  *2 
[8]  Cl-^2  x{ 55x55) -55x51 

[9j  P0-^(55*2  )-5i  *2 

[10^  ,C5  ,(74  ,(73  ,C2  .Cl  ,(70 

Lll]  Z-^ROOTER  F 

7 


7 ^(^(JPFALL)  J 7 

7 Z^tiOOTER  F;G;5F;DI(7;A 
[Ij  Z^O  2pDl(7-^-l 

[2  J Z-^Z.Ll  J(  (FP^”l+(p5)L(l?:iKt>F)  xl)pO),[l.lJO 

[3j  -*-0  X 1 1 =p5-t-( -5p) +5 

[4  J Z-^Z  , L 1 . ( (,FP-^-”l  +(  pF)L(l*l+F)  il)pL/iO),Ll.  IjO 

L5j  -►Oxx  i = p5+-5P  + 5 

[6j  F-^ 25^/7  FtP[1j 

i.  7 ] FP^DERIV  F 

[8'j  51:A-^I-^0 

[9j  ->F3x;  1 = 1+5^  ,Yj.FP 

[10^  X^X-h^iXLF)iG 

[ 11  j ->■(  ( 50  <1^1+1  ),(20<U),(1  = 1+A),1)/63,53,62,61+1 
[12j  62  : Z-^Z  . [ 1 jfxA',  0 

[13]  -+(  61 -1  )xi2pp-f-  1 + (1,-A)PP  F 

[14]  L3  :FP->-DEHIV  F->-<t>F 

[15j  X*-I-*-0 

[16]  -»-65xi  1=1+5^  ;j:xFP 

[17j  X^X-A->-iXxF)iG 

[18]  -►((  50  <1-1+1  ),  (20<U)  , (1  = 1+A  ) , 1 )/65 , 65 , 64 .63+2 

[19]  64  ; Z-Z  . [ 1 ]_Tx£+A  ) , 0 

[20j  FP-^DERIV  F-  1 + (1,-A)P5  F 
[21j  -+(  63 +1  )x  1 2pp 

[22]  65  : Z-Z  . [ 1 ]rxP5(77'4>F 
7 


Functions  nested  in  ROOTER  are  avilable  in  Workspace 

606  9GKM*MATH 
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PREVERSE 


ENTER  IRE  INPUT  MATRIX 
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THETAl 
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THETAl 

_ 7 6. 41506556  _129. 7599918  163.0356789 

76.41506556  129.7699918  “163.0356789 

iHETA'2, 

141.4287657  107.2939594  49.97364364 

218.5712343  252.7060406  310.0263564 
THE  REQUIRED  INPUT  ANGLES 

20.98406925  112.1615754  “142.9579259 
54.70359527  226.2894777  76.93928085 

A’ 2 

2.334200081  4.849479673  2.70632323 
1.444516028  3.892403726  6.290942305 
72 

.8952708981  _ .5196774998  .3015953655 

2.040434622  4.509662774  .999458941 
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l4]  XY^U 

L5  J XX<-0  , (ax20(  0x6  ) ) . ( .3094)x2O(Ovl.2)) 
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APPENDIX  D 


COMPUTER  PROGRAMS  OF 


CHAPTER  7 


The  programs  used  to  perform  the  analysis  and  to 
generate  the  data  for  the  plots  of  Chapter  7 are  stored 
in  the  Harris  computer  of  the  CIMAR  computer  system  under 
workspace  3010DT7*PHD, 
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V ifiPSPLaj  V 

V RPSP  iXO  i ZO  i AA  i BB  i B 'l’Q  \ I i J i 52  ; S6 
Llj  REVERSE  ANALYSIS  OF  THE  H-P-SP  DEVICE 

[2j  'BHTER  THE  LENGTH  OF  THE  BASE  SIDE’,  SA' 

L 3 j 5/1 

[4j  'ENTER  THE  OFFSET  OF  THE  SLIDER-,  52  2 1 . 52  2 2 , 522  3 ’ 

[5j  522-^D 

L6]  'ENTER  THE  COOR.OF  THE  POINT’,  XQ  , YQ  , ZQ' 

[7]  XYZ->-U 

[ 8 j p 0 

[9j  R-*-SQ'*~S2'*-3  3p0 

CIO]  P5I^552-<-556-^7  3 3p0 

[11]  BETA->-iQ  120  240)x(o1)t180 

[12]  /liP/l-^-C  (02)^72  )x  ( i73  )-l 

[13]  XO-^0  , (5>lx(  3*.  5)^4  ) ,s^x(  3*.  5)t4 

[14]  ZO-^iO  ,SA  ,-SA)i^ 

[ISj  J^O 

[16j  LQ-.J^J^l 
ini  1^0 
[13]  7.1: 1^1+ 1 

[ 19  J /l/l^(Z5[r.|x5^io5£27l[Ij  )-25[J]x5^2oSPr4[r] 

[20J  BS-^-(25[I]x5)  + A:a[Ijx5 

[21]  S^4  4p5.0a-S)  ,/!/3. 0.1, 0,0. 5, 0,5.65. 0.0, 0.1 

[ 22  J P4-<-3  3p45 , 0 , 45. 0 , 1 , 0 , ( - 45-<-10.4  5P/4[c7j  ) , 0 , 46’->-2045P4  [«/] 

[23]  A[;I]-<-C^  1451-^6+ . x(J^(,^yZ  . 1 ) 

[24]  56[  ;J]-»-(  1 145)  + . x56’^-(2’^i+.  x(55-h3  lp5,0,5)) 

[25]  ^64x1 (i=56[ 3 ;Ij  + l ) 

L26j  556[J;Ij-*--a[3;IjT56[3;J] 

L27  j 55  -.5UM*-ni  ; J]  556  [ J ; I]  x 55  [ ;PJ 

[ 28  J 52 [ -,Il->-SUMiNORM->-{  y(s^SUM)  + . ^SUM)*.  5 

[29  j P5P[c7;/j-^(S2[  2 ;I  iQUA~S2il  ;i  ] ) x l 80  t ( ol  ) 

[30]  552[^;IJ^,V5AiV-522[rj 

[31]  52  : -*-Ll  X 1 ( J<  3 ) 

[32j  -*LQx\iJ<pALFA) 

[33]  'THE  REQUIRED  ANGULAR  DISPLACEMENT;' 

[34]  PHI 

[35]  'THE  REQUIRED  SLIDING  DISPLACEMENT;' 

[36j  552 

[37]  'ANGLE  OF  ROTATION  ABOUT  THE  Y-AXIS;' 

[38]  45F4xl80f(Ol) 

[39]  ->-0 

[40]  54  :556[«/;IJ^0 

[41]  -»-55 
V 


15 
3 3 


54 

52  2 
3 

XYZ 
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REVEiiSb  ANALYSIS 


l3j  fl  STEWART  PLATFORM  WITH  A SLIDING  INPUT  JOINT 
[4] 

[5j  'ENTER  THE  RADII  OF  THE  PLATFORM  AND  THE  BASE',' 

[ 6 ] RI*-Q 

[7J  'ENTER  THE  OFFSETS',' 

[8J  544^0 

[9]  'ENTER  THE  COOR.  OF  THE  POIN  T ',  XQ  ,Y  Q , ZQ ',  ' 

[ 1 0 j X-^U 

[llj  (02  )t6  )x  ( I 6 ) -1 

[12j  /4LFX1-^(  (02  )t72  )x  ( I 73  )-l 

L 1 3 j ^J-«-54'<-3  6p  0 

[14]  554-*-73  6p0 

[15]  J-^Q 

[16]  L0:J->-J+l 

[17]  1^0 
[18j  Bl:i^I+l 

[ 19 ] F^{ 0^208 ET All  1 ) . ( [ 2 ] ) . 0 . 0 . 0 , 1 

[20j  B-^4  4pC.O,  ( -5)  ,0. 0,  1.  0, 0 . (5-^10B£l'/5  [Ij  ) , 0,F 

[21 J M->-10ALFAlJl 

[22]  N*-2oALFAlJ'j 

[23]  ;^4  4p/7.0,y^,A:[l].0.1.0,.Y[2],(-.flf)  ,0,/'v',;t[3].0.0.0,l 

[24J  ^<[;I]-^  1 04S+ . x(2-'+ , x(  4 Ip  (iVI[  1 ]x5)  , o , (al[  1 ]x<:)  , i ) ) 

[25]  S4[  ;Ij-hC[  nORM<-{  ( fijQ  [ ; I j ) + . x^[  ;!]  )*  . 5 

[26]  5S4[c7;I  j-/»fOA'A/-S44[I  J 
[ 27  ] L2 :^Ll xi ( J<6 ) 

[28]  -*00x1  iJ<p  ALFA) 

[29]  'THE  REQUIRED  SLIDING  DISPLACEMENTS',' 

[30 J 554 

[31j  'ANGLE  OF  ROTATION,  ALFA' 

[32]  /^5F.4^/15F/3x180t(o1) 

[33j  ALFA 
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L3j  ft  SI'&'w/lAr  PA4i'’FOA7V  WIl'H  AN  ACTUATED  REVOLUTE  JOINT 

[5j  'ENTER  THE  RADII  OF  THE  PLATFORM  AND  THE  BASE-,' 

L 6 j 

[7J  'ENTEn  THE  COOR.  OF  THE  PO INT XQ  ,YQ  ,ZQ ' 

L 8 j a-*-Q 

[9]  BETA-GAMA-^i  (;  02  ) ^ 6 ) x ' x 6 ) - 1 

LlOj  ALFA*-{.{02)i72)^{ \T3)-1 

Cll]  C'^54^3  6p0 

[I2j  PHI<-7  3 6 2p0 

[13]  J-^0 

L 1 4 J L 0 : J-^  J 

[15j  1^0 

[I6j  Ll:I->-I+l 

[ 17  J F->-iC-^2oBETALl]  ) . ( -AI[2]  ) ,0. 0. 0.  1 

[18j  S-^4  4pC.O  , ( -5)  .0, 0.  1 . 0, 0,  (5^10S£2',4[IJ  ) ,0.F 

[19  J M->-10ALFALJ1 

[20]  N*-20ALFAlJ~3 

[21]  T^4  4pA,0,W,Z[l],0,1.0.A[2],(-W) ,0.A.A[3],0.0,0,1 

[22j  q[;Ij-^  1 0 + S+ . x(r+ . x(  4 1 p ( AI[  1 ] x 5)  , Q , x AJ  [ i ] x p ) , i ) ) 

[23j  o4[;Ij-^^i[;I  iiN0RM-<-{  (i^Q[  ;Ij  )+.  xg[  ;l_j  )*.  5 

[24]  6'2^(  l-(  (F2^-54[3  ;Ij  )*2  ) )*.  5 

[25]  A-^l 

[26]  £4  :C1-^54[1  ;i  jt52 
L27j  51-f-S4[2  ;Ijf  52 

[23]  PHIIJ-,I-,K'S*-C1  QUA  51 
[29j  ->£5x1  ( CA  + 1 )^2  ) 

L 30  ] A'-*-A  + l 

[31]  S2^-S2 

[32]  ->£4 

[33]  £5  : -►£1  X X ( I <6  ) 

[34]  ^-£0xx  (c£<p/1££’4) 

[35  J 'THE  REQUIRED  ANGULAR  DISPLACEMENTS',' 

[36j  PAI-^PAIx180t(O1) 

[37j  PHI 

[38]  'ANGLE  OF  ROTATION-,  ALFA' 

[39]  /1£P/]-^-4£F.4x  1 80  T ( 01  ) 

[40j  ALFA 
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